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Abstract 

I’his  report  documents  our  recent  progress  in  exploring  balance  and  dynamic  stability  in  legged  systems. 

There  have  been  five  areas  of  progress,  each  described  in  a  separate  chapter  in  die  pages  that  follow. 

•  Balance  in  2D  can  be  achieved  with  a  surprisingly  simple  control  system.  The  control  system  has 
three  separate  parts,  one  that  controls  hopping  height,  one  that  controls  the  velocity  of  forward 
travel,  and  one  that  controls  body  attitude.  A  physical  2D  one-legged  hbpping  machine  that 
employs  such  a  three-part  control  system  hops  in  place,  runs  from  place  to  place  at  speeds  of  up  to 
2.7  rnph,  maintains  its  balance  when  disturbed,  and  leaps  over  small  obstacles. 

•  Control  of  locomotion  in  3D  can  build  upon  the  results  obtained  in  2D.  Simulations  suggest  that 
a  3D  one-legged  machine  could  run  and  balance  using  die  same  three-part  controller  developed 
for  2D,  provided  that  additional  extra-planar  mechanisms  operate  to  suppress  roll,  yaw,  and 
lateral  motions. 

•  Wo  have  designed  and  built  a  physical  one-legged  system  diat  will  permit  experimentation  in  the 
control  of  balance  in  3D.  The  device  has  a  simple  pneumatic  leg  that  is  positioned  by  a  hydraulic 
hip.  It  will  hop  on  an  open  floor  without  a  system  of  physical  constraints. 

•  Last  year  we  developed  a  method  for  obtaining  balance  that  uses  tabulated  data.  This  year  the 
method  was  extended  by  showing  that  the  volumous  tabular  data  can  be  approximated  by  a 
polynomial  surface  of  moderate  degree,  without  much  loss  of  control  precision. 

<*  We  refined  our  understanding  of  the  mechanisms  responsible  for  balance  by  simulating  and 
comparing  three  different  algorithms  for  horizontal  conttol:  one  just  places  the  foot  during  flight, 
one  places  the  foot  during  flight  and  sweeps  the  leg  during  stance,  and  the  third  places  the  foot 
during  flight  and  controls  body  attitude  during  stance.  Each  of  the  dircc  methods  elucidates  a 
different  principle  of  dynamic  stability. 

The  report  closes  with  a  bibliography  on  legged  locomotion  containing  about  350  references. 
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1.  Introduction  and  Summary 

v, 

')  Humans  and  animals  use  their  legs  to  loeomote  with  great  mobility,  but  we  do  not  yet  have  a  full 
understanding  of  how  they  do  so.  One  sign  of  our  ignorance  is  the  lack  man-made  vehicles  that  use  legs  to 
obtain  high  mobility.  A  legged  vehicle  might  someday  travel  in  difficult  terrain,  where  softness  or  bumpiness 
makes  wheeled  and  tracked  vehicles  ineffective.  'Hie  research  reported  here  was  designed  to  address  both  the 
scientific  problem  of  understanding  bow  living  legged  systems  operate,  and  the  engineering  problem  of  how 
to  build  useful  legged  vehicles. 

Our  research  strategy  is  to  focus  on  the  problems  of  balance  and  dynamic  stability,  while  postponing  to  later 
the  study  of  gait  and  coupling  among  many  legs.  To  do  this  we  have  modeled,  simulated,  and  built  a  number 
of  systems  that  hop  and  balance  on  just  one  leg.  In  the  one-legged  regime  balance  is  of  paramount 
importance,  while  coordination  and  coupling  do  not  apply.  A  secondary  strategy  has  been  to  examine  systems 
with  springy  legs,  so  that  the  role  of  resonant  oscillatory  leg  behavior  might  be  better  understood. 

The  main  thrusts  of  the  work  during  the  past  year  has  been  to  do  experiments  on  a  physical  21)  one-legged 
hopping  system  that  balances  as  it  runs,  to  simulate  a  3D  one-legged  system,  to  build  a  physical  3D  machine 
for  future  experiments,  and  to  refine  our  previous  theoretical  work  on  2D  balance.  This  report  is  a  collection 
of  five  separate  papers  that  describe  these  projects.  The  major  Findings  are  summarized  here: 


1 .1  2D  Experiments 


A  physical  21)  one-legged  hopping  machine  has  been  operating  in  the  laboratory  now  for  almost  a  year.  A 
single  set  of  control  algorithms  maintains  balance  as  the  machine  hops  in  place,  runs  from  one  place  to 
another,  and  leaps  over  small  obstacles.  Top  recorded  running  speed  is  about  2.7  mph.  When  the  machine  is 
bopping  in  place,  a  person  can  disturb  it  by  pushing  sideways  without  causing  it  to  lose  balance. 


The  most  important  thing  about  the  control  system  for  the  21)  one-legged  machine  is  its  simplicity.  Three 
separate  servos  operate  independently  to  control  hopping  height,  forward  travel,  and  body  attitude: 

•  flopping  Height:  The  control  system  regulates  hopping  height  by  manipulating  hopping  energy. 

The  leg  is  springy,  so  hopping  is  a  bouncing  motion  that  is  generated  by  an  actuator  that  excites 
the  leg.  Hoppine  height  is  determined  by  the  energy  recovered  from  the  previous  hop,  the  losses 
in  (lie  flopping  cycle,  and  thrust  developed  in  the  leg  actuator.  Height  is  regulated  by  adjusting 
the  amount  of  thrust  on  each  cycle  to  just  make  up  for  losses. 

o  Velocity:  The  control  system  manipulates  forward  velocity  by  placing  the  foot  with  respect  to  the 
center  of  the  C(i- print  on  each  step.  The  CG-print  is  the  locus  of  points  on  the  ground  over  which 
the  center  of  gravity  of  the  system  w  ill  pass  during  stance.  Displacing  the  foot  from  the  center  of 
the  CG-print  causes  the  >ystem  to  run  either  faster  or  slower.  The  control  system  calculates  the 


Figure  M:  Hie  21)  hopping  machine  running  and  leaping.  Action  is  Iron)  right  lo 
left  in  both  photographs  I  H )s  indicated  paths  of  the  foot  and  hip.  I  OI’:  Running 
at  about  2  mph  v.ith  04  in  i ride  ItC)  I  I  ()\1:  The  same  controller  that  balances  when 
hopping  in  place  and  when  running  forward,  can  he  used  during  leaping  lire  vertical 
control  program  is  modified  lo  generate  extra  thrust  and  to  retract  the  leg.  Obstacle  is 
b  \  (i  inches. 


3 


length  of  the  CG-print  from  the  measured  forward  velocity  and  an  estimate  of  the  duration  of 
stance.  The  error  in  forward  velocity  determines  a  foot  position  that  will  maintain  the  correct 
speed  of  forward  travel. 

•  Attitude:  The  control  system  maintains  an  erect  body  posture  during  running,  by  generating  hip 
torques  during  stance  that  servo  u'm  body  angle.  During  stance  friction  between  die  foot  and 
ground  permits  large  torques  to  be  applied  »o  the  body  without  causing  large  accelerations  of  the 
leg.  These  torques  are  used  to  implement  a  simple  proportional  servo  that  moves  the  body  toward 
an  erect  posture  once  each  step. 

1.2  Decomposing  3D  Balance  Into  Planar  and  Extra-Planar  Parts 

The  same  three-part  control  system  that  operates  to  balance  the  2D  machine  can  be  applied  to  balance  in  3D. 
We  have  begun  to  explore  die  notion  that  motion  of  dynamically  stable  3D  legged  systems  can  be 
decomposed  into  a  planar  part  and  an  extra-planar  part  The  planar  part  is  like  that  already  described  for  2D, 
controlling  large  leg  and  body  motions  that  provide  hopping  and  forward  travel.  'Fhe  extra-planar  part 
produces  only  subtle  corrective  motions  that  maintain  planarity.  These  motions  must  eliminate  errors  in  roll, 
yaw,  and  lateral  translation. 

Motivation  for  this  approach  came  from  observing  animals.  Running  animals  seem  to  operate  in  2D,  with 
their  legs  swinging  fore  and  aft  through  large  angles -while  die  body  bobs  up  and  down.  The  body  may  also 
pitch  back  and  forth  quite  markedly.  These  large  planar  motions  do  not  tell  the  whole  story,  since  locomotion 
takes  place  in  3-space  where  tilings  can  move  with  six  degrees  of  freedom.  Motions  that  enforce  planarity  are 
usually  not  obvious. 

We  have  designed  a  controller  that  uses  these  ideas  to  balance  a  simulated  3D  one-legged  machine.  In 
addition  to  die  dircc  parts  developed  for  the  2D  machine,  there  are  controllers  for  roll  and  yaw.  Control  of 
heading  is  treated  in  a  special  way  that  needs  further  work,  and  we  have  not  yet  begun  to  study  active  aiming 
while  running.  Simulation  data  show  good  control  of  velocity,  body  attitude  and  spin  while  traversing  paths 
made  up  of  straight  segments.  These  findings  indicate  diat  decomposition  results  in  a  very  simple  solution 
that  seems  to  be  in  concert  with  what  we  observe  in  natural  systems. 


1.3  Design  and  Construction  of  a  3D  One-Legged  Hopping  Machine 

While  2D  experiments  have  taught  us  a  great  deal  about  control  of  hopping,  forward  velocity  and  attitude, 
real  locomotion  takes  place  in  3D  where  yaw,  roll  and  lateral  drift  must  also  be  controlled.  We- are  anxious  to 
extend  our  experimental  results  to  the  3D  case.  The  notion  that  control  of  locomotion  can  be  very  simple 
receives  die  acid  test  in  3D,  because  the  dynamic  equations  that  describe  motion  in  3D  arc  much  more 
complicated  than  in  2D. 


Figure  1*2:  Simulated  one-legged  machine  used  to  study  algorithms  for  balance  in 
3D. 


We  have  built  a  machine  for  these  experiments.  Like  the  2D  machine,  it  hops  on  one  springy  leg  with 
hopping  motions  powered  by  compressed  air.  Hydraulic  actuators  control  orientation  of  the  leg  with  respect 
to  the  body.  A.  3-axis  force  sensing  font  provides  measurements  of  vertical  loading  and  traction  forces.  A 
two-axis  vertical  gyro  and  an  electronic  compass  provide  measurements  of  the  body’s  orientation  in  space. 
We  arc  currently  applying  the  principles  of  planar  decomposition  to  the  control  and  balance  of  this  3D 
one-legged  machine. 

1 .4  Tabular  Control  in  Leggod  Locomotion 

We  have  developed  a  tabular  control  method  that  is  particularly  well  suited  to  controlling  the  non-linear 
dynamics  of'lcggcd  systems.  Control  of  systems  with  non-linear  dynamics  is  difficult  when  simple  expressions 
that  relate  the  behavior  of  die  system  to  die  available  control  signals  arc  not  available.  Manipulators  have 
been  controlled  using  carefully  organized  tables  that  contain  prc-computcd  data,  but  such  tables  are  typically 
very  large.  We  have  found  that  it  is  possible  to  reduce  the  size  of  the  tallies  needed  for  control,  by  capitalizing 
on  die  cyclic  character  of  legged  locomotion,  in  which  movements  arc  repeated  one  stride  after  another. 


Figure  1-3:  Machine  to  be  used  for  experiments  on  balance  in  3D  Hopping  motion 
is  powered  by  compressed  air,  but  hydraulics  are  used  to  orient  leg  piccisely  with 
respect  to  the  body,  Ihe  foot  can  sense  load  and  traction  forces,  and  a  gyroscope 
measures  orientation  of  the  body  in  space.  An  umbilical  connects  the  machine  to 
power  supplies  and  the  control  computer,  which  are  located  nearby  in  the  laboratory. 
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While  die  tables  designed  for  manipulator  control  typically  require  one  dimension  for  each  state  or 
configuration  variable,  the  new  tabular  method  employs  a  table  that  represents  only  a  subset  of  the  state 
variables.  Behavior  of  die  remaining  state  variables  is  nearly  the  same  on  each  cycle,  so  they  need  not  be 
represented  explicitly  in  the  table.  For  the  ease  of  die  simulated  2D  one-legged  system,  the  control  table  has 
dimension  4,  and  stores  about  20,000  numbers.  Control  using  the  tabular  method  results  in  very  good 
performance,  eliminating  velocity  limit  cycles  that  occur  when  linear  feedback  is  used. 

We  have  also  conti oiled  the  simulated  2D  system  with  multi-variate  polynomials  that  approximate  the  tabular 
data.  This  approach  will  permit  treatment  of  problems  larger  than  a  pure  tabular  method  can  handle, 
provided  additional  computing  power  is  available  to  evaluate  the  polynomials.  Control  data  arc  presented  for 
polynomials  with  24,  40, 68,  and  625  terms.  We  have  found  that  the  40  term  polynomial  provides  surprisingly 
good  control,  at  only  moderate  storage  and  computational  cost. 


Tigure  1-1:  The  three-part  control  algorithm  responds  to  step  changes  in  desired 
velocity,  (shown  stippled).  Separate  controllers  modidute  thrust  to  regulate  hopping 
height,  place  foot  during  flight  to  control  forward  velocity,  and  generate  hip  torque 
during  stance  to  control  attitude  ol  the  body.  Ihcse  simulation  data  are  designed  to 
allow  comparisons  among  the  various  mechanisms  that  contribute  to  control  of 
balance  mid  forward  travel. 
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1 .5  Modeling  and  Simulation  of  2D  One*Legged  Running 

Our  understanding  of  balance  has  progressed  through  a  number  of  stages.  First  we  explored  hopping  itself, 
since  balance  could  only  be  addressed  once  a  locomotion  cycle  that  alternated  periods  of  support  with  periods 
of  flight  had  been  established.  Then  we  examined  the  importance  of  foot  placement  as  a  means  of  controlling 
tipping  and  forward  travel.  Introducing  the  notion  of  the  CG-print,  the  locus  of  points  over  wh»ch  the  center 
of  gravity  travels  during  stance,  permitted  us  to  generalize  our  results  on  foot  placement  <o  the  case  where 
forward  velocity  was  important.  This  generalization  led  to  sweep  control.  Finally,  in  doing  physical 
experiments  on  the  2D  hopping  machine,  we  found  that  body  attitude  could  be  controlled  separately  from 
hopping  and  foot  placement.  'ITic  result  was  the  three-part  control  algorithm  mentioned  earlier. 

We  reexamined  these  four  aspects  of  control;  hopping,  foot  placement,  the  CG-print.  and  three-part 
decomposition.  We  have  gone  back  and  produced  a  systematic  set  of  equations,  simulations,  and  tests  that 
help  to  reveal  the  power  and  role  played  in  legged  locomotion  by  each  mechanism. 


2.  Experiments  with  the  2D  One-Legged  Machine 


2.1  Abstract 

The  ability  to  balance  is  important  to  tire  mobility  of  logged  creatures  found  in  nature.  The  study  of  this 
ability  may  someday  lead  to  versatile  legged  vehicles.  In  order  to  study  the  role  of  balance  in  legged 
locomotion  and  to  develop*  effective  control  strategies,  a  2D  hopping  machine  was  constructed  for 
experimentation.  The  machine  has  one  leg  on  which  it  hops  and  runs,  making  balance  a  prime  consideration. 
Control  of  the  machine's  locomotion  was  decomposed  into  three  separate  parts:  a  vertical  height  control  part, 
a  horizontal  velocity  part,  and  an  angular  attitude  control  part.  Experiments  showed  that  the  three  part 
control  scheme,  while  very  simple  to  implement,  was  powerful  enough  to  permit  the  machine  to  hop  in  place, 
to  am  at  a  desired  rate,  to  translate  from  place  to  place,  and  to  leap  over  obstacles. 


2.2  Introduction 

A  key  to  die  mobility  obtained  by  legged  systems  that  arc  dynamically  stabilized  is  their  ability  to  remain 
upright  without  a  broad  continuous  base  of  support.  The  ability  to  loeomote  on  a  narrow  base  permits  travel 
where  obstructions  are  closely  spaced,  or  where  die  only  support  path  is  a  narrow  one.  The  ability  to. 
loeomote  using  intermittent  support,  or  support  points  that  are  separated  from  one  another  gives  flexibility  to 
the  choice  of  where  and  when  to  place  the  feet.  For  instance  in  rough  terrain  feet  are  placed  only  on  those 
locations  that  provide  good  support,  even  when  they  arc  separated  by  large  distances.  Biological  legged 
systems  routinely  lake  advantage  of  these  features  of  dynamic  stability,  narrow  base  and  intermittent  support, 
to  traverse  terrain  diat  can  not  be  traversed  by  wheel  or  tread. 

Previous  experimental  work  on  balance  began  with  Cannon's  control  of  inverted  pendulums  that  rode  on  a 
small  powered  truck  [141].  His  experiments  included  balance  of  a  single  pendulum,  two  pendulums  one  atop 
the  other,  two  pendulums  side  by  side,  and  a  long  limber  pendulum.  Matsuoka  [197]  implemented  a  very 
simple  one-legged  hopping  machine  that  lay  on  a  table  inclined  10°  from  the  horizontal.  Kato  et.  al.  [169] 
have  studied  quasi-dynamic  walking  in  die  biped,  in  their  studios  a  ‘10  kg  biped  with  10  hydraulically  driven 
degrees  of  freedom  used  a  preplanned  motion  to  dynamically  transfer  support  from  one  foot  to  the  other. 
Miura  and  his  students  [230]  built  an  electrically  powered  biped  that  balanced  itself  in  3D  using  a  tabular 
control  scheme.  With  only  three  actuated  degrees  it  used  a  shuffling  gait  to  balance  that  reminds  one  of 
Charlie  Chaplin. 

The  present  study  explores  the  control  of  a  physical  one-legged  hopping  machine.  The  objective  of  using  a 
machine  with  only  one  leg  was  to  avoid  the  problem  of  coordinating  many  legs,  thereby  simplifying  the 
experiments,  while  at  the  same  time  drawing  attention  to  the  issues  of  dynamic  stability  that  arc  central  to 
versatile  legged  systems.  Study  of  a  one-legged  system  also  addressed  die  question  of  intermittent  support  in 
locomotion,  because  die  only  gait  .nailable  was  hopping.  A  related  objective  was  to  explore  lire  use  of  springy 
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legs  in  obtaining  efficient  hopping,  as  animals  do  (7).  Springy  legs  permit  energy  to  be  recovered  from  one 
step  so  that  it  may  be  used  to  power  the  next  step.  Experimental  results  obtained  from  a  physical  device  with 
one  springy  leg  confirm  the  feasibility  of  the  control  strategies,  previously  tested  only  in  simulation. 

This  chapter  reports  experimental  results  obtained  by  controlling  a  physical  one-legged  device,  which  is 
described  in  the  next  section.  Section  .1  describes  how  control  of  the  device  can  be  decomposed  into  three 
simple  parts,  and  presents  the  three  corresponding  con'rol  algorithms.  Data  arc  presented  in  section  4  that 
were  obtained  by  using  the  three  algorithms  to  control  the  hopping  machine.  They  illustrate  the  ability  of  the 
algorithms  to  control  hopping  height,  to  maintain  balance,  to  regulate  travel  from  place  to  place,  to  respond  to 
sudden  disturbances,  and  to  leap.  Section  5  closes  with  conclusions  and  a  summary. 

2.3  The  One-Legged  Device 

The  2D  hopping  machine  shown  in  Fig.  2-1  was  designed  and  constructed  to  do  experiments  in  balance.  Its 
main  parts  arc  a  body  and  a  leg  connected  by  a  simple  hip.  "llicrc  is  also  a  mechanism  that  constrains  motion 
of  the  hopping  machine  to  two  dimensions.  'Hie  body  consists  of  a  platform  that  mounts  sensors,  valves, 
actuators  and  computer  interface  electronics,  and  a  weighted  beam  that  increases  the  moment  of  inertia  of  the 
body. 

The  leg  consists  of  a  double  acting  air  cylinder  with  a  rubber  cushion  attached  to  die  lower  end  of  the  rod  to 
form  a  foot.  The  narrow  foot,  about  1.  cm  when  flilly  loaded,  provides  a  good  approximation  to  a  point  of 
support.  The  coefficient  of  friction  between  the  foot  and  the  floor  in  our  laboratory  is  about  0.6.  Delivery  of 
air  pressure  to  the  top  end  of  the  cylinder  drives  the  piston  and  rod  assembly  downward,  providing  the 
vertical  thrust  for  hopping.  The  leg  air  cylinder  acts  as  a  spring  when  the  valves  controlling  air  flow  seal  it  off. 
This  air  cushion  provides  an  opportunity  to  transfer  die  kinetic  energy  from  one  hop  to  the  next  hop,  thereby 
reducing  die  energy  cost  of  continuous  hopping. 

Under  the  best  test  condition  die  air  spring  recovered  about  65%  of  the  energy  from  one  hop  and  returned  it 
to  the  next  hop.  The  ratio  of  body  mass  to  the  mass  of  die  reciprocating  portion  of  die  leg  is  about  20:1.  This 
results  in  a  5%  energy  loss  when  the  device  lands  on  die  ground,  and  when  it  leaves  the  ground,  as  explained 
in  Chapter  5.  Friction  in  die  leg  actuator  accounts  for  the  other  hopping  losses. 

The  leg  and  body  are  connected  by  a  hinge-type  pivot  joint  that  forms  a  hip.  The  angle  between  body  and  leg 
at  the  hip  is  controlled  by  a  single  stage  proportional  air  servo  valve  that  drives  a  pair  of  single  acting  air 
cylinders.  A  potentiometer  provides  a  measurement  of  this  angle  to  the  control  computer  that  servos  the  joint 
with  a  simple  linear  servo: 
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Figure  2*1:  The  one- legged  device  used  Tor  experiments  has  two  primary  parts:  a 
body  and  a  leg.  The  body  provides  mounting  for  valves,  electronics  and  sensors,  and 
has  a  balance  beam  that  increases  its  moment  of  inertia.  The  leg  is  a  double  ended  air 
cylinder  that  pivots  with  respect  to  the  body,  and  that  carries  a  padded  foot  on  one 
end  of  the  rod.  Four  two-way  pneumatic  valves  control  flow  of  compressed  air  to  and 
from  each  end  of  the  leg  cylinder.  Air  can  be  trapped  in  the  cylinder  to  make  it  act 
like  a  spring.  Another  set  of  pneumatic  actuators  powered  by  a  proportional  servo 
valve  acts  between  the  leg  and  body  to  control  angle  of  the  hip.  On  board  sensors 
measure  length  of  the  leg.  angle  between  leg  and  body  angle  between  leg  and  ground 
(only  during  stance),  contact  between  foot  and  ground,  pressure  in  the  leg  air 
cylinder  and  inclination  of  the  body  with  respect  lo  the  vertical. 


r(t)  =  IWW  +  KV,L«V 


where 

t( t)  is  the  actuator  torque  generated  at  the  hip. 

K,tV  Kv,l  are  position  and  velocity  gains  during  flight,  and 
d  is  the  desired  leg  angle.  (Values  given  in  Appendix  I.) 

A  full  40°  sweep  of  the  leg  takes  approximately  120  msec.  The  ratio  of  moment  of  inertia  of  the  body  to  that 
of  the  leg  is  15:1.  This  relatively  high  ratio  ensures  that  the  orientation  of  die  leg  may  be  changed  during 


Might  without  severely  disturbing  body  attitude.  The  center  of  gravity  of  the  body  is  located  at  the  hip,  so  the 
only  moments  acting  on  the  body  arc  those  generated  by  the  hip  actuator. 


Figure  2-2:  Tether  boom  mechanism  constrains  motion  of  one-legged  device  to 
surface  of  a  sphere,  fhe  tether  consists  of  a  section  of  aluminum  tubing  with  a 
spherical  bearing  at  the  stationary  pivot  end,  and  a  fork  pivot  at  the  hopper  end.  The 
main  boom  holds  the  hopper  2.5  m  from  the  pivot  center,  giving  it  radial  and  yaw 
stability,  while  a  pair  of  nylon  cables  prevent  roll.  These  cables  also  keep  the  foot  a 
nearly  constant  radius  from  the  pivot  point  as  the  leg  changes  length,  minimizing 
radial  scrubbing.  Instrumentation  mounted  at  the  pivot  provides  measurement  of  the 
three  primary  motions:  vertical  translation,  horizontal  trans'auon,  and  rotation  about 
the  axis  of  Jic  boom. 


Motion  of  die  hopping  machine  is  constrained  to  die  2D  surface  of  a  large  sphere  by  the  tether  boom  shown 
in  Fig.  2-2.  This  mechanism  permits  the  hopping  machine  to  translate  vertically  and  horizontally,  and  to 
rotate  about  the  axis  of  die  tether  boom.  Since  the  tcdier  boom  is  made  of  cables  and  light-weight  tubing, 
weight  and  friction  arc  sufficiently  small  to  be  ignored.  The  tether  boom  arrangement  permits  the  machine  to 
travel  around  the  laboratory  on  a  circle  of  radius  2.5  m.  Sensors  mounted  on  the  tether  boom  pivot  provide 
measurements  of  the  three  free  motions.  An  umbilical  is  attached  to  the  tether  boom  that  carries  compressed 
air  to  drive  die  actuators,  as  well  as  electrical  power  and  communication  with  die  control  computer. 

Sensors  mounted  on  the  hopping  machine  provide  state  information  to  a  nearby  control  computer  and  permit 
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performance  to  be  measured.  Potentiometers  measure  the  angle  between  body  and  leg,  the  angle  between  leg 
and  ground,  and  the  length  of  the  leg.  A  switch  mounted  on  the  foot  senses  contact  with  the  ground.  A 
pressure  transducer  measures  compression  of  air  in  the  leg  air  cylinder.  A  rate  gyroscope  mounted  on  the 
body  of  the  hopper  senses  its  angular  rate.  This  signal  is  also  integrated  to  estimate  attitude  of  the  body  with 
respect  to  the  ground:  this  estimate  is  periodically  corrected  for  drift  using  the  combined  leg  and  hip  angle 
measurements.  The  pitch  motion  to  which  the  gyroscope  is  sensitive  is  also  measured  by  instrumentation  of 
the  tether  boom. 


Figure  2-3:  Sequence  of  photos  showing  one  complete  stride  of  the  hopping  machine 
running  from  left  to  right  ItteVground  grid  spacing  is  2  m  Running  speed  here  is 
.75  ir/sec  Stride  45  in,  stride  period  6N0  msec  Adjacent  frames  separated  by  ICO 
msec. 


1°  makc  1,10  macliinc  hop  the  leg  actuator  is  pressurized  during  the  stance  phase  of  each  cycle  and  partially 
exhausted  during  the  flight  phase.  The  timing  of  pressure  and  exhaust  arc  chosen  to  excite  the  spring-mass 
oscillator  formed  by  the  leg  and  body.  Peak  to  peak  amplitude  of  body  oscillation  can  be  varied  between  .04 
and  .3  m.  with  corresponding  bouncing  frequencies  of  about  3  to  1.5  per  second.  Over  this  range  of  bouncing 
frequencies  the  stance  period  is  nearly  constant  varying  by  only  a  few  percent,  as  expected  for  a  spring-mass 
system. 

lo  make  the  machine  balance  while  traveling  from  place  to  place,  the  foot  is  positioned  during  flight  and  the 
hip  is  torqued  during  stance.  During  flight,  a  forward  position  for  die  foot  is  chosen  appropriate  to  the 
machine’s  rate  of  travel.  During  stance,  torques  arc  developed  at  the  hip  to  maintain  the  body’s  upright 
posture.  The  resulting  control  ,/stem  produces  running  at  rates  of  up  to  1.2  m/sec  (2.7  mph)  with  strides  of 
up  to  .6  m.  Gencial  operation  of  the  machine  is  shown  in  Figure  2-3.  These  photographs,  taken  in  rapid 
sequence  throughout  one  stride,  show  the  machine  running  at  .75  m/scc  (1.7  mph). 

2.4  Control 

Control  of  running  in  the  one-legged  device  was  decomposed  into  three  separate  parts.  One  part  controls  the 
height  to  which  the  device  hops  by  modulating  die  vertical  thrust  generated  in  the  leg.  A  second  part  controls 
forward  velocity  by  positioning  the  foot  on  each  step  prior  to  landing.  The  third  part  controls  attitude  of  the 
body  by  generating  torques  at  the  hip  during  die  stance  phase.  The  timing  of  these  diree  controllers  is 
synchronized  to  the  ongoing  activity  of  the  hopping  machine  by  a  sequencer  that  receives  input  from  die 
various  sensors.  Beyond  coordinated  timing,  there  are  no  explicit  interdependencies  among  the  three  control 
parts.  Ibis  independence  results  in  a  particularly  simple  control  design  diat  is  effective  when  the  system  is 
hopping  in  place,  when  it  translates  from  one  point  to  another,  when  it  accelerates  to  change  running  speed, 
and  when  it  leaps. 

2.4.1  Height  Control 

Hopping  height  is  regulated  by  manipulating  die  duration  of  thrust  of  the  leg.  If  die  system  were  left  to 
bounce  passively  on  the  springy  leg,  losses  in  the  sliding  friction  of  the  air  cylinder  and  in  accelerating  and 
decelciating  the  unsprung  mass  of  die  leg  would  soon  cause  die  device  to  conic  to  rest.  Measurements  of  die 
decay  in  hopping  height  during  passive  hopping  showed  that  such  energy  losses  amounted  to  about  35%  on 
each  cycle.  A  vertical  thrust  is  provided  every  cycle  that  just  compensates  for  these  losses 

Ihrust  is  produced  by  permitting  compressed  air  at  supply  pressure  to  (low  into  the  upper  part  of  the  leg 
cylinder.  The  inflowing  compressed  air  is  added  to  that  compressed  by  shortening  of  the  leg  as  it  absorbs 
kinetic  energy  on  the  previous  hop.  Pressure  in  die  cylinder  acts  on  the  leg  to  accelerate  die  body  upward. 

I  lie  magnitude  of  this  acceleration,  and  therefore,  die  velocity  of  the  device  when  the  leg  is  fully  extended, 
are  determined  by  the  amount  of  kinetic  energy  recovered  from  the  previous  hop  and  the  length  of  time  the 
intake  valve  is  left  open. 


Equilibrium  occurs  when  the  energy  lost  in  one  hopping  cycle  equals  the  energy  introduced  through  the 
intake  valve.  Since  losses  arc  monotonic  with  hopping  height,  a  unique  stable  hopping  height  exists  for  each 
value  of  thrust.  Details  of  die  relationship  between  hopping  height  and  duration  of  thrust  were  determined 
empirically.  The  height  controller  regulates  the  height  of  hopping  by  manipulating  the  duration  that  the 
intake  valve  is  left  open. 

This  scheme  works  quftc  well  provided  the  thrusting  direction  of  the  leg  is  vertical.  During  running 
significant  deviations  from  vertical  occur,  so  variations  in  hopping  height  occur.  Uniforrri  hopping  height 
could  be  obtained  during  running  with  an  algorithm  that  took  the  changing  kinematics  of  the  device  into 
account,  but  this  was  not  done  here. 

2.4.2  Velocity  Control 

Each  time  a  hopping  or  running  system  leaves  the  ground,  a  foot  must  be  moved  to  a  position  that  will 
balance  the  system  during  the  next  stance  interval.  The  goal  is  to  ensure  that  there  is  support  and  to  control 
horizontal  motion  of  the  machine.  The  forward  velocity  of  the  system  during  flight  is  used  to  calculate  an 
appropriate  foot  position  for  landing. 

During  stance  die  system  behaves  like  an  inverted  pendulum.  Gravity  generates  a  moment  about  the  foot 
proportional  to  the  horizontal  displacement  of  the  foot  from  the  projection  of  the  center  of  gravity  of  the 
system.  When  the  foot  is  located  directly  under  die  center  of  gravity,  die  device  tips  neither  forward  nor 
backward,  if  the  foot  is  offset  from  die  projection  of  the  center  of  mass,  say  to  the  rear,  the  device  will  tip  in 
die  opposite  direction,  to  the  front.  When  die  device  tips  the  body  accelerates  horizontally.  In  such  a 
dynamically  stable  system  it  is  not  possible  to  prohibit  tipping  at  all  times.  Rather,  die  velocity  control 
algorithm  must  manipulate  these  tipping  motions  and  the  ensuing  accelerations  to  control  forward  movement. 

Hie  strategy  used  here  was  to  choose  a  foot  position  based  on  die  predictable  nature  of  the  alternation 
between  stance  and  flight,  and  constraints  imposed  by  a  system  moving  at  constant  velocity.  When  the  device 
U'nvels  with  constant  horizontal  velocity,  balance  is  maintained  by  causing  die  average  tipping  moment  to  be 
approximately  zero  over  each  stride.  This  results  in  no  average  horizontal  acceleration  over  cadi  stride,  and 
no  average  angular  acceleration. 

The  distance  traveled  during  stance  is: 

Ax  =  x2Tst  (2.2) 

where 

x2  is  the  horizontal  velocity  of  the  body,  assumed  to  be  constant,  and 
T  is  die  duration  of  die  stance  phase. 

The  locus  of  points  over  which  die  center  of  gravity  travels  during  die  stance  period,  called  the  CG-print , 
extends  from  x,  ( to  xv  U  +  A\.  where  x,  (  }is  the  position  of  the  CG  at  touch-down.  To  minimize  die  tipping 
moment  Juiing  stance,  the  foot  should  be  placed  in  the  center  of  the  CG-print: 
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xo  = 


(2.3) 


where 

xQ,  x2  arc  the  horizontal  positions  of  the  foot  and  body. 

This  positioning  of  the  foot  causes  the  horizontal  and  vertical  motions  of  the  leg  to  be  symmetrical  about  the 
midpoint  of  the  stance  interval,  at  which  point  the  leg  is  vertical  and  maximally  compressed.  During  stance: 

*i(fro+t)  =  e^-t)  (2.4) 

vV(tTD  +  t)  =  WUlo-O  (2.5) 

where 

tm  is  the  time  of  touch-down  and 

TD 

t  is  the  time  of  lift-off. 

LO 

Tipping  moments  and  forward  accelerations  are  also  nearly  symmetrical,  and  therefore  average  to  zero. 

When  the  fool  lands  precisely  in  the  center  of  the  CO-print.  forward  velocity  is  not  affected.  To  accelerate 
the  system,  cither  to  compensate  for  velocity  errors  or  to  change  speed,  a  tipping  moment  is  purposely 
generated.  When  the  foot  is  placed  forward  of  the  center  of  the  CG-print,  then  the  device  will  tend  to  tip 
backward,  which  slows  it  down.  If  the  foot  is  placed  rearward,  then  it  will  tip  forward,  increasing  forward 
velocity.  A  linear  function  of  velocity  error  is  used  to  generate  deviations  in  foot  placement  from  the  center  of 
the  CG-print: 

xhu.  =  K<xrxid>  <2-6) 

where 

x?  d  is  the  desired  values  for  x2  and 
K.  is  a  feedback  gain. 

Augmenting  (2.3)  with  (2.6)  yields: 


Ax 

=  x2  +  +  ^C(x2— x2  d) 


The  corresponding  angle  of  the  leg  that  will  yield  this  foot  position  is  given  by: 


(2.7) 


„  ,  Ax  +  2x„„ , 

e\ ID  =  ArCSm  (  - ) 

2w 


(2.8) 
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.  /x  Te_  +  2  K(x,-x,  ,4)  v 
=  Arcsin  ( — SI - - 1  U L  ) 

2w 


The  algorithm  of  (2.8)  has  limitations  at  high  velocity.  As  long  as  (Ax/2)  «  wllAV  and  8 ,  is  small, 
horizontal  forces  generated  by  compression  of  the  leg  are  small  and  (2.8)  is  reasonably  accurate.  However, 
this  condition  is  not  satisfied  in  fast  running.  In  that  case  xTO  ~  wMAX  and  0Y  MAX  is  large;  horizontal  forces 
decelerate  the  system  during  the  first  half  of  stance,  then  accelerate  it  during  the  second’ half,  making  the 
average  forward  velocity  during  stance  less  than  the  overall  average.  Under  these  circumstances  the  CG-print 
is  substantially  shorter  than  estimated  by  (2.8).  As  a  practical  matter  this  problem  was  avoided  by  substituting 
the  average  value  of  x2  during  stance  in  (2.8)  for  the  overall  average. 


2.4.3  Attitude  Control 

Since  angular  momentum  of  the  system  is  conserved  during  flight,  the  control  system  can  manipulate  attitude 
of  the  body  only  during  stance  when  ground  forces  act  on  the  foot.  Torques  generated  during  stance  between 
the  leg  and  body  can  be  use  to  servo  the  attitude  of  the  body  to  any  desired  orientation; 

r(t)  =  KpsT(02-02d)  +  Kvst«?2)  (2.9) 

where 

Kv,r  are  position  and  velocity  gains  used  for  the  hip  servo  during  stance,  and 
8 2  d  is  the  desired  attitude  of  the  body,  zero  in  this  report. 

2.4.4  Sequence  Control 

For  a  legged  system  to  loeomote  each  leg  must  alternate  between  a  support  phase  in  which  the  foot  touches 
the  ground  and  bears  weight,  and  a  transfer  phase  when  the  foot  is  elevated  to  move  from  one  foothold  to 
another.  At  the  heart  of  the  control  system  lies  a  sequencer  that  ensures  such  an  alternation  by  coordinating 
height,  velocity,  and  attitude  controllers  to  the  timing  of  the  machine's  support  and  transfer  phases.  This 
coordination  relics  on  sensors  that  signal  the  transition  from  one  phase  to  another.  For  example,  support 
begins  when  pressure  begins  to  buiid  in  the  leg  cylinder,  and  the  leg  begins  to  shorten.  The  remaining 
transitions  and  transition  states  for  the  hopping  cycle  are  shown  in  Fig.  2-4. 

As  the  hopping  system  nears  the  ground  two  events  happen  in  rapid  succession.  First  there  is  contact  with  the 
ground,  then  the  leg  bears  a  load.  Contact  is  important  because  horizontal  motions  of  the  leg  required  for 
foot  placement  during  flight  should  not  continue  when  die  foot  is  very  close  to  die  ground.  If  dicy  do,  then 
unwanted  torques  may  be  inadvertently  generated  on  die  body,  upsetting  its  attitude.  Since  friction  between 
foot  and  ground  develops  in  proportion  to  the  normal  force,  generation  of  hip  torques  to  control  the  attitude 
of  the  body  must  await  adequate  vertical  loading.  For  these  reasons  die  time  between  first  contact  and 
load-bearing  support  is  treated  as  a  twilight-zone  during  which  dimst,  foot  placement,  and  attitude  control 
processes  arc  inoperative.  Another  twilight-zone  occurs  when  die  system  leaves  die  ground.  Lift  off  begins 
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Figure  2*4:  Finite  state  controller  uses  sensor  measurements  to  synchronize  the 
various  phases  of  control  with  the  cyclic  activity  of  the  locomotion  system.  Actions  of 
the  height,  velocity,  and  attitude  controls  are  coordinated  by  this  state  controller  as  it 
sequences  through  the  hopping  cycle. 

and  attitude  control  ends  when  extension  of  the  leg  is  nearly  complete.  However,  to  ensure  that  the  foot  is 
fully  unloaded  before  it  is  moved,  no  torques  arc  generated  at  die  hip  until  the  foot  switch  opens. 

The  precautions  taken  during  touch-down  and  lift-off  to  avoid  motion  of  the  foot  when  it  is  not  fully  loaded 
arc  not  optimal  for  high  speed  running.  When  miming  at  high  speed  the  foot  should  not  merely  be  left 
motionless  during  touch-down,  but  should  accelerate  to  match  die  relative  speed  of  the  moving  ground  before 
actually  touching  it.  At  lift-off  the  foot  should  continue  moving  backward  until  it  is  fully  unloaded.  Running 
animals  such  as  the  kangaroo  and  cat  match  their  feet  to  ground  speed  in  this  way  [7],  but  the'  hopping 
machine  has  not  yet  been  made  to  do  so. 
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2.5  Experimental  Results 

The  experimental  hardware  and  control  algorithms  described  above  were  used  to  verify  the  effectiveness  and 
workability  of  the  three-part  control  decomposition,  to  evaluate  and  refine  the  control  algorithms,  and  to 
demonstrate  balance  in  a  man-made  running  system.  The  height,  velocity,  and  attitude  control  algorithms 
and  the  sequence  controller  of  die  last  section  were  implemented  in  a  set  of  control  programs  that  ran  on  a 
minicomputer.  They  controlled  the  hopping  machine  and  recorded  its  behavior.  The  experiments  tested 
vertical  hopping,  horizontal  travel,  and  leaping. 
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Figure  2-5:  Data  recorded  while  hopping  machine  hopped  in  place.  Every  5  seconds 
duration  of  vertical  thrust  was  adjusted  to  change  hupping  height  In  each  case  it  took 
about  2  seconds  and  4  cycles  to  adjust.  Upper  curve  is  elevation  of  hip,  middle  curve 
is  elevation  of  foot.  Lower  curve  indicates  duration  of  thrusL  (a323. 10) 


2.5.1  Vertical  Hopping 

To  demonstrate  control  of  hopping  height,  data  were  recorded  by  the  control  computer  while  a  new  height 
setpoint  was  specified  every  5  seconds.  The  results  arc  plotted  in  Fig.  2-5.  Each  time  the  setpoint  was 
changed  it  took  four  or  five  hops  for  die  height  to  stabilize.  In  these  records  the  machine  hopped  vertically  in 
one  place  with  no  translation.  Four  cycles  of  these  data  arc  rcplottcd  in  the  y,  vs.  y2  phase  plot  of  Fig.  2-6. 
The  indentation  at  the  upper  right  is  due  to  the  sudden  acceleration  experienced  by  the  body  when  the  leg 
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was  accelerated  to  body  speed.  The  upper  part  of  this  diagram  is  parabolic  due  to  gravity’s  constant 
acceleration,  while  the  lower  part  would  be  harmonic  for  a  linear  spring.  Since  the  air  spring  is  hard \  the 
trajectory  is  not  quite  harmonic. 
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Figure  2-6:  Four  cycles  like  those  shown  in  Fig.  2-5  replottcd  here  in  pbnsc  diagram 
form.  The  curves  cross  the  axes  at  ui'T  off.  top,  touch  down,  and  nonoM.  Note 
Lliat  position  is  plotted  on  ordinate,  velocity  on  abscissa,  and  time  progresses  in 
counterclockwise  direction.  (a344.1) 


2.5.2  Horizontal  Travel 

We  examined  the  system’s  ability  to  regulate  rate  of  translation  during  running  by  having  the  control 
computer  specify  a  ramp  in  desired  velocity  while  recording.  The  results  arc  plotted  in  Fig.  2-1.  These  data 
show  the  machine,  first  hopping  in  place,  then  running  at  increasing  rates  up  to  about  ,9  tn/scc.  Throughout 
die  am  velocity  was  controlled  to  within  about  .25  m/scc  of  the  desired  value.  This  accuracy  is  typical.  It  was 


possible  to  improve  velocity  regulation  at  lower  rates  by  reducing  the  velocity  error  gain  of  (2.7),  and  at  higher 
rates  by  increasing  this  gain.  With  a  high  velocity  error  gain,  stable  running  at  1.2  m/scc  (2.7  mph)  was 
obtained  for  a  few  seconds  at  a  time.  Algorithms  that  use  non-linear  velocity  error  feedback  provided 
promising  results,  but  were  not  adequately  developed  to  be  included  here. 
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During  running,  the  leg  and  body  counter-oscillate  as  shown  in  the  plots  of  61  and  dr  The  back  and  forth 
motions  of  the  leg  were  not  explicitly  programmed,  but  resulted  from  interactions  between  the  velocity 
controller  that  operated  during  flight,  and  the  attitude  controller  that  operated  during  stance.  Oscillations  of 
the  body  are  to  be  expected  because  angular  momentum  is  conserved  during  flight,  and  attitude  correction 
occurs  only  during  stance. 

The  plot  of  0,  also  shows  that  average  body  angle  deviated  from  zero,  the  setpoint,  in  rough  proportion  to 
running  speed.  These  deviations  were  very  small,  typically  only  a  few  degrees,  even  for  rapid  'running.  The 
average  deviation  of  body  inclination  from  the  desired  value  could  be  further  minimized  By  taking  the 
expected  body  rotation  into  account  when  specifying  the  setpoint  used  by  the  attitude  controller: 

S2d  =  ^2d  +  “i"Arcsin(~SI)  (2.10) 

'  I2  2w 

where 

I1%I2  are  the  moments  of  inertia  of  die  leg  and  body  respectively. 

Hopping  height  and  stride  frequency  were  also  affected  by  running  speed,  as  indicated  by  the  plot,  of  body 
altitude,  yv  Actually,  the  relevant  factor  is  not  running  speed  directly,  but  die  angle  of  the  leg  at  touch-down. 
Faster  running  resulted  in  large  deviations  of  the  leg  from  vertical,  and  therefore,  shallower  hops.  These 
shallower  hops  took  iess  flight  time  resulting  in  more  rapid  stepping.  At  0.9  m/sec  peak  foot  clearance  was 
reduced  by  20%.  and  stride  period  was  reduced  by  8.6%.  This  result  is  reminiscent  of  data  showing  that 
kangaroos  hopped  at  slightly  higher  frequency  as  dicir  forward  velocities  increased  [64]. 

A  position  controller  was  used  to  make  the  hopping  machine  translate  from  place  to  place.  Position  control 
was  implemented  with  a  controller  that  transformed  position  errors  into  desired  velocities: 

x2,d  =  K  min<  <x2  '  X2,d)-X3,max  >  (2-n> 

This  algorithm  prevented  the  machine  from  attempting  very  rapid  translations  when  it  was  far  from  the  target. 
Desired  positions  were  sometimes  specified  with  a  joystick  that  was  manipulated  by  the  operator,  and 
sometimes  specified  by  the  control  computer  according  to  a  preplanned  sequence.  Data  obtained  while  the 
device  was  position  controlled  is  plotted  in  Fig.  2-8.  A  limit  cycle  of  about  ±  .1  m  is  present  whenever  the 
machine  is  hopping  in  place. 

Also  shown  in  this  Fig.  2-8  is  the  response  to  an  external  disturbance.  After  about  25  seconds  the 
experimenter  delivered  a  sharp  horizontal  jab  to  the  body  as  the  machine  hopped  in  place.  (Sec  dotted 
vertical  line  in  figure.)  balance  was  recovered  and  the  machine  returned  to  its  commanded  position  after  a 
few  seconds.  The  control  system  tolerated  fairly  strong  disturbances  of  this  sort,  provided  die  forces  exerted 
on  the  body  were  primarily  horizontal.  Disturbances  that  introduced  large  rotations  of  the  body  often  led  to  a 
crash. 
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Figure  2-7:  Rate  control  of  the  hopping  machine  was  tested  by  varying  x,  the  rate 
set  poi.it  (shown  stippled),  along  a  ramp  from  0.  to  1.0  tn/scc  in  ltl  see.  The 
maximum  speed  obtained  in  this  trial  over  an  entire  stride  was  about  .95  tn/scc  (2.1 
mph).  Dashed  line  on  y.  curve  separates  stance,  data  below  line.  rrom  flight. 
(aJ37.12) 
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Figure  2*8:  Position  control  was  achieved  by  manipulating  desired  rate  of  translation, 
as  described  in  text.  After  4.3  seconds  of  stationary  hopping  the  computer  specified  a 
4  meter  step  change  in  desired  position.  (Vertical  dotted  line):  Experimenter 
disturbed  the  machine  by  delivering  a  sharp  horizontal  jab  with  his  hand.  It  returned 
to  the  setpoint  within  a  few  seconds.  (a324.19) 


2.5.3  Leaping 

A  specialized  vertical  control,  program  was  used  to  make  the  hopping  machine  leap  while  die  standard 
velocity  and  attitude  controls  operated  normally.  During  such  experiments  the  machine  approaches  the 
obstacle  with  a  moderate  running  rate.  One  step  before  die  obstacle  die  operator  presses  the  leap  button, 
initiating  a  preplanned  sequence  synchronized  to  vertical  hopping: 

1.  During  the  next  stance  phase,  thrust  is  delayed  so  that  the  leg  shortens  more  than  normal  under 
load  of  the  body.  This  is  done  to  prepare  for  a  hop  of  maximum  height.  Thrust  begins  at  bottom, 
not  stopping  undl  the  leg  has  fully  lengthened. 

2.  Once  airborne,  the  leg  shortens  and  its  swinging  motion  is  delayed:  both  provide  extra  clearance. 

3.  When  top  is  reached  hip  angle  is  servoed  to  the  correct  landing  angle  as  usual.  There  is  less  Ume 
to  position  the  foot  than  normal,  but  the  shorter  leg  is  moved  more  quickly  due  to  its  reduced 
moment  of  inertia. 

4.  Hie  log  is  lengthened  in  preparation  for  landing. 

5.  Upon  landing,  the  standard  hopping  sequence  is  re-established. 

During  the  leaping  sequence,  velocity  and  attitude  controls  continued  to  operate  in  the  usual  manner. 

This  procedure  was  used  to  leap  over  a  stack  of  styrofoam  blocks,  as  shown  in  Fig.  2-9.  While  many 
successful  leaps  were  obtained  in  this  manner,  equally  many  resulted  in  crashes.  Clearing  an  obstacle  requires 
that  the  foot  be  placed  quite  precisely  before  the  leap,  that  the  leap  have  sufficient  altitude,  and  that  the  leap 
have  sufficient  span.  The  existing  algorithm  docs  a  good  job  with  height  and  span,  but  has  no  means  for 
adjusting  die  take-off  point. 


Figure  2-9:  Hopping  .nachiiic  leaping  over  an  obstacle  Machine  approaches  from 
right.  'Hie  leaping  sequence  is  described  in  text  Travel  continues  to  the  left  after 
leap  Obstacle  is  19  in  tall  and  15  m  wide  The  photograph  was  made  with  a  low 
frequency  strobe,  while  small  light  souices  indicated  paths  of  the  foot  and  hip 


2.6  Discussion 

While  the  primary  purpose  of  using  a  one-legged  apparatus  for  these  experiments  was  to  focus  on  balance,  an 
additional  goal  was  to  develop  a  model  that  could  explain  the  behavior  of  each  leg  in  more  complicated 
systems  that  run.  If  we  ignore  the  third  dimension,  generalizing  from  the  one-legged  machine  to  the  two- 
legged  hopping  kangaroo  is  very  easy.  A  direct  comparison  can  be  made  between  the  motions  of  the  hopping 
machine’s  one  leg  and  the  motions  of  the  kangaroo’s  pair  of  legs.  The  primary  difference  is  that  the  kangaroo 
uses  its  tail  to  help  compensate  for  the  large  sw  eeping  motions  of  the  legs,  so  that  the  body  need  not  react  by 
pitching  so  much  on  each  hop.  The  control  system  can  still  regulate  hopping  hcigln,  body  attitude,  and 
velocity  as  before. 
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Many  characteristics  of  the  running  biped  are  also  similar  to  the  running  one-legged  machine,  including  the 
alternation  between  stance  and  (light,  die  regular  vertical  oscillations,  and  the  periods  of  support  by  only  one 
leg.  In  die  ease  of  the  biped,  the  two  legs  always  swing  in  opposite  directions,  making  rotations  of  the  body  or 
a  tail  unnecessary,  ihitik  of  a  biped  as  a  hopping  machine  that  substitutes  a  different  leg  on  each  stride,  The 
dircc  part  decomposition  can  be  employed  as  before.  'Ihc  three  part  control  system  can  also  be  used  to 
understand  how  a  quadruped  runs.  This  is  described  elsewhere  by  Raibert  and  Sutherland  |290|. 

The  specific  algorithms  described  here  might  be  useful  in  discovering  die  locomotion  mechanisms  used  by 
biological  systems.  While  the  parallels  between  behavior  of  the  one-legged  hopping  machine  and  various 
biological  systems  arc  provocative,  the  mechanisms  responsible  for  control  in  biological  systems  are  still  not 
known.  Ihc  algorithms  described  in  diis  report  allow  specific  predictions  that  could  be  explored 
experimentally.  Ihc  most  clear  cut  predictions  arc  dial  hip  torque  during  stance  is  uniquely  used  to  adjust 
body  attitude,  and  that  speed  is  controlled  through  placement  of  the  feet.  The  following  experiments  might 
elucidate  dicse  questions: 

•  Hxamine  kinematic  data  to  determine  if  human  runners  position  their  feet  according  to  (2.7). 

•  Suppose  a  human  running  at  constant  speed  were  externally  accelerated  forward  during  flight,  or 
made  to  think  he  was  accelerated  forward.  Would  the  angle  of  the  leg  with  respect  to  the  vertical 
at  touch-down  change  according  to  the  algorithm  given  above? 

•  Suppose  a  human  running  at  constant  speed  were  externally  rotated  forward  during  flight,  with  no 
linear  acceleration  of  the  CG.  Would  leg  angle  change  in  that  ease? 

•  If  the  body  of  a  running  human  were  linearly  accelerated  during  stance  without  disturbing  body 
attitude,  would  there  be  a  correction  before  die  next  step? 

We  do  not  know  if  it  is  technically  feasible  to  do  such  experiments,  but  the  results  could  provide  important 
clues  to  the  mechanisms  responsible  for  balance  in  existing  legged  systems. 


2.7  Conclusions 

This  chapter  describes  an  experimental  hopping  machine  and  a  set  of  experiments  designed  to  elucidate  the 
basic  problems  of  dynamic  stability  and  balance  in  legged  systems  that  hop  and  run.  I  lie  present  work  was 
done  in  order  to  verify  the  correctness  of  principles  originally  developed  in  simulation,  and  to  get  practical 
experience  that  might  some  day  he  valuable  in  designing  a  practical  vehicle. 

It  was  found  that  control  of  die  one-legged  hopping  machine  can  be  decomposed  into  three  separate  parts 
that  are  synchronized  by  the  behavior  of  the  machine  One  part  controls  hopping  height  by  choosing  a  fixed 
amount  of  energy  to  inject  on  each  hopping  cycle.  A  second  control  part  regulates  the  forward  travel  of  the 
system  by  placing  the  foot  a  specific  distance  in  front  of  the  hip  as  the  dev  ice  approaches  Ihc  ground  on  each 
step.  The  third  controller  con  eels  the  attitude  of  the  body  by  applying  appioprintc  torques  to  the  hip  during 


stance  when  vertical  loading  permits  horizontal  forces  to  be  generated  at  the  foot  A  finite  state  sequencer 
provides  the  glue  that  synchronizes  the  actions  of  the  three  controllers  to  the  ongoing  behavior  of  the  device. 

Experiments  showed  that  the  relatively  simple  control  algorithms  obtained  good  control  of  the  machine. 
They  maintained  consistent  hopping  heights,  reaching  equilibrium  after  a  change  within  a  few  hopping  cycles. 
The  device  ran  at  speeds  of  up  to  i.2  m/soc.  At  low  velocity,  speed  regulation  was  rather  poor,  but  improved 
when  traveling  at  higher  rates.  The  machine  traveled  from  place  to  place  using  position  control.  A 
modification  to  the  vertical  control  algorithm  enabled  the  machine  to  leap  over  small  obstacles. 
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2.8  Appendix  I.  Physical  Parameters  of  One-Leggod  Hopping  Machine 

Leg  mass  - 1.31  kg 

Leg  moment  of  inertia  •  .036  kg-m2 

Body  mass  ■  7.18  kg 

Body  moment  of  inertia  •  .52  kg-m2 

K  =  .035  m/(m/scc) 

KpST  =  153.  Nt-m/rad 
Kvst  =  14.  Nt-m/( rad/sec) 

K  _  =  47.  Nt-m/rad 

P.FL 

KyFL  =  1.26  Nt-m-/(rad/scc) 
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3,  3D  Balance  Using  2D  Algorithms 

3.1  Abstract 

This  chapter  explores  the  notion  that  the  motion  of  dynamically  stable  3D  legged  systems  can  be  decomposed 
into  a  planar  part  that  accounts  for  large  leg  and  body  motions  that  provide  locomotion,  and  an  extra-planar 
part  that  accounts  for  subtle  corrective  motions  that  maintain  planarity.  The  largo  planar  motions  raise  and 
lower  the  legs  to  achieve  stepping,  and  they  propel  the  system  forward.  The  extra-planar  motions  ensure  that 
the  legged  system  remains  in  the  plane.  A  solution  of  this  form  is  simple  because  3D  dynamics  do  not  play  an 
important  role. 

We  develop  a  model  of  a  3D  one  legged  hopping  machine  that  incorporates  a  springy  leg  of  non-zero  mass 
and  a  two  axis  hip.  1h:  hopping  machine  is  modeled  as  an  open  loop  linkage  that  has  different 
configurations  in  flight  and  in  stance.  Behavior  at  transitions  between  phases  is  calculated  by  invoking 
conservation  of  momentum.  We  have  decomposed  control  of  the  model  into  four  parts  that  control  hopping 
height,  forward  velocity,  body  attitude,  and  spin.  Hopping  height  is  controlled  by  regulation  of  vertical 
energy.  Velocity  is  controlled  by  placing  the  foot  fore  or  aft  during  flight  Body  attitude  is  controlled  by 
torquing  the  hip  during  stance.  Spin  is  controlled  by  placing  the  foot  outside  the  plane  of  motion.  Simulation 
data  are  presented  which  show  that  these  control  algoridims  result  in  good  control  of  velocity,  body  attitude 
and  spin,  while  moving  on  a  straight  desired  path. 

3.2  Introduction 

The  locomotion  of  legged  systems  is  a  form  of  motion  that  has  gained  the  attention  of  biologists  seeking  to 
understand  the  behavior  they  observe  in  natural  organisms,  and  of  engineers  who  attempt  to  build  useftil 
legged  vehicles.  Animators  and  film  makers  have  also  shown  interest,  but  mostly  in  simulating  the 
appearance  of  systems  that  use  legs  to  lucomotc.  Our  interest  is  not  so  much  in  the  appearance  or  description 
of  locomotion,  as  it  is  in  the  underlying  mechanisms  that  are  responsible  for  production  and  control  of  such 
motion.  In  particular  we  have  focused  on  die  problem  of  controlling  the  motion  of  systems  diat  balance  as 
they  run. 

Dynamic  stability  is  a  key  ingredient  in  die  mobility  exhibited  by  legged  systems.  Systems  that  balance  can 
move  on  a  narrow  base  of  support,  permitting  travel  where  obstacles  arc  closely  spaced  or  where  die  support 
path  is  narrow.  A  dynamically  stabilized  system  need  not  be  supported  at  ail  times  and  may  therefore  use 
support  points  diat  are  widely  separated  or  erratically  placed.  These  characteristics  relax  the  constraints  on 
die  type  of  terrain  a  legged  system  can  negotiate. 

Casual  observation  of  a  running  animal,  say  a  cat,  a  horse,  or  a  kangaroo,  might  lead  one  to  conclude  that 
running  in  a  straight  line  is  a  2D  activity.  The  legs  swing  fore  and  alt  through  large  angles  while  the  body 


bobs  up  jnd  down.  The  body  may  also  undergo  pitching  motions  that  are  quite  pronounced.  These  large 
motions  of  the  legs  and  body  propel  the  animal  upward  so  that  the  feet  may  be  picked  up  and  placed  on  a 
new  spot,  they  allow  the  animal  to  balance  itself  so  that  it  does  not  tip  either  forward  or  backward,  and  they 
propel  the  animal  forward  so  that  transportation  takes  place.  However,  these  large  planar  motions  do  not  tell 
the  whole  story.  Natural  legged  locomotion  takes  place  in  a  3-spacc  where  motion  with  six  degrees  of 
freedom  is  possible. 

To  study  dynamically  stable  locomotion  in  3D  we  have  modeled  a  system  with  just  one  leg  and  a  very  small 
foot.  This  simple  one-legged  model  allows  us  to  address  the  dynamic  stability  problem  squarely,  while  totally 
ignoring  the  coupling  problem  that  complicates  the  analysis  of  systems  with  many  legs.  Our  goal  is  to  test  the 
idea  that  control  for  legged  systems  running  in  3-spacc  need  not  explicitly  deal  with  the  complications  of  3D 
dynamics.  Rather  it  may  be  feasible  to  decompose  the  problem  into  a  planar  part  that  controls  locomotion 
using  the  large  motions  described  above,  and  an  extra-planar  part  that  uses  only  very  subtle  motions  to  restrict 
behavior  to  the  plane.  Decomposition  results  in  a  very  simple  solution  that  seems  to  be  in  concert  with  what 
we  observe  in  natural  systems. 

3.2.1  Background 

Previous  studies  of  balance  in  3D  legged  systems  have  been  earned  out  by  a  number  of  workers,  most  notably 
in  Europe  and  Japan.  Vukobratovic  and  his  co-workers  [164,  338.  J42J  have  developed  the  notion  of  zero 
nw»wi>t  point.  control.  They  have  shown  in  simulation  how  a  3D  multi-linked  walking  biped  can  be 
balanced  by  manipulating  the  relationship  between  the  projection  of  die  center  of  gravity  and  the  support 
areas  provided  by  die  feet.  Kato  ct.  al.  [169]  have  studied  quasi-dynamic  walking  in  die  biped.  In  their 
studies  a  physical  biped  widi  10  hydraulically  driven  degrees  of  freedom  used  a  preplanned  sequence  of 
quasi-static  motions  to  dynamically  transfer  support  from  one  large  foot  to  the  other.  Miura  and  his  students 
(230j  have  built  a  number  of  small  electrically  powered  walking  bipeds  that  balance  using  tabular  control 
schemes.  Their  most  advanced  model  demonstrates  dynamic  balance  without  large  feet.  It  has  three  actuated 
degrees  of  freedom  diat  permit  each  leg  to  move  fore  and  aft.  to  move  sideways,  and  to  lift  slightly  off  the 
floor.  1'his  machine  balances  with  a  shuffling  gait  that  reminds  one  of  Charlie  Chaplin's  stiff-kneed  walk. 

Hopping  has  also  been  studied.  Fifteen  years  ago  Seifert  [302]  explored  the  idea  of  using  a  large  pogostick  for 
transportation  on  the  moon,  where  low  gravity  would  permit  very  long  hops.  Matsuoka  [196]  analyzed  2D 
hopping  in  humans  with  a  one-legged  model,  assuming  dial  die  leg  could  be  massless,  and  diat  the  stance 
period  could  be  of  very  short  duration.  He  derived  a  time-optimal  state  feedback  controller  diat  stabilized  his 
system.  Matsuoka  [197]  also  implemented  a  very  simple  one-legged  hopping  machine  diat  lay  on  a  table 
inclined  10°  from  the  horizontal. 

Summarizing  work  that  appears  elsewhere  in  this  report,  we  have  found  that  for  the  a  2D  one-legged 
machine,  the  control  of  locomotion  could  be  subdivided  into  three  largely  independent  parts:  regulation  of 
hopping  height,  control  of  forward  velocity,  and  control  of  attitude. 
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•  Height:  The  control  system  regulated  hopping  height  by  manipulating  hopping  energy.  The 
machine  had  a  springy  leg,  so  hopping  was  a  bouncing  motion  that  was  generated  by  an  actuator 
that  excited  the  leg  spring.  Hopping  energy  was  conserved  by  the  leg  spring  from  hop  to  hop. 

The  height  to  which  the  machine  hopped  was  determined  by  the  energy  recovered  from  the 
previous  hop,  and  by  the  losses  in  the  hopping  cycle.  Since  all  energy  in  the  system  is  convened 

.  to  potential  energy  by'  the  peak  of  a  hop,  hopping  height  could  be  regulated  by  injecting  an 
’  appropriate  amount  of  energy  during  each  step. 

•  Ve’ocitv:  The  control  system  manipulated  forward  velocity  by  moving  the  leg  during  the  flight 
part  of  each  hop  to  properly  position  the  foot  with  respect  to  die  CG- print.  The  CG-print  is  die 
locus  of  points  on  die  ground  over  which  the  center  of  gravity  of  die  system  will  pass  during  the 
next  stance  period.  If  the  foot  is  placed  in  die  center  of  the  CG-print,  the  device  will  tip  neither 
forward  nor  backward,  but  will  continue  its  forward  motion  at  about  the  same  rate  as  before.  If 
the  foot  is  placed  rearward  of  die  center  of  CG-print.  Uicn  the  device  will  tip  forward,  increasing 
its  forward  velocity.  If  the  foot  is  placed  forward  of  the  center  CG-print,  then  the  device  will  dp 
backward,  decreasing  its  velocity.  The  control  system  calculated  the  length  of  the  CG-print  from 
the  measured  forward  velocity  of  die  device  and  the  estimated  duration  of  stance.  The  control 
system  dicn  used  the  error  in  forward  velocity  to  position  the  foot  to  control  and  correct  the 
forward  speed  of  locomotion. 

•  Attitude:  The  control  system  maintained  an  erect  body  posture  during  running,  by  generating  hip 
torques  during  stance  diat  servoed  the  body  angle.  During  stance,  friction  between  the  foot  and 
ground  permitted  large  torques  to  be  applied  to  the  body  without  causing  large  accelerations  of 
the  leg.  These  torques  were  used  to  implement  a  simple  proportional  servo  that  returned  the  body 
to  an  erect  posture  once  each  step. 

In  diis  chapter  we  extend  this  approach  to  3D  locomotion  for  die  case  of  straight  line  running.  To  do  so  we 
have  modeled  and  simulated  a  3D  one-legged  hopping  machine  that  moves  freely  on  an  open  floor.  Hopping 
height  is  controlled  as  before  in  the  2D  case.  In  order  to  extend  the  2D  control  system  to  3D,  we  must  modify 
it  to  handle  diree  new  degrees  of  freedom:  lateral  translation,  roll  orientation,  and  yaw  orientation. 


3.3  Modeling  and  Simulation 

The  model,  shown  in  Fig.  3-1,  has  two  primary  parts:  a  body  and  a  leg.  The  body  is  represented  by  a  rigid 
mass  with  substantial  moment  of  inertia  about  its  three  primary  axes.  (Sec  Appendix  II  for  simulation 
parameters.)  The  leg  is  a  long  slender  linkage  diat  is  springy  in  its  axial  dimension,  with  a  small  foot  at  one 
end.  The  leg  is  connected  to  the  body  by  a  universal  hip  joint  that  provides  two  degrees  of  freedom. 

All  three  joints  in  die  machine  arc  actuated.  The  hip  is  driven  by  a  pair  of  torque  actuators  that  can  be  used  to 
orient  die  leg  with  respect  to  the  body,  or  to  change  the  attitude  of  die  body  when  die  foot  is  in  contact  with 
die  ground.  The  leg  is  driven  by  a  diird  actuator  that  operates  in  series  with  a  passive  spring.  Changes  in  the 
length  of  diis  actuator  are  used  to  excite  the  leg  spring  and  to  make  me  machine  hoo. 
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Figure  3*1:  The  3D  one-legged  system  modeled  in  this  report.  It  has  a  body  and  a 
leg,  connected  by  a  hip.  The  body  is  a  rigid  structure  with  mass  and  moment  of 
inertia.  The  leg  has  mass  and  moment  of  inertia,  and  an  actuated  spring  along  its  long 
axis.  The  body  and  leg  are  connected  by  a  hip  with  two  orthogonal  axes  of  rotation, 
both  driven  by  a  torque  source.  Model  parameters  arc  given  in  Appendix  II 


In  addition  to  the  model’s  three  actuated  joints,  called  internal  degrees  of  freedom,  the  model  has  external 
degrees  of  freedom  that  permit  it  to  move  with  respect  to  its  surroundings.  During  stance,  when  the  foot 
touches  the  ground,  there  arc  three  external  degrees  of  freedom  that  give  the  model’s  orientation  in  space. 
During  flight  when  the  foot  loaves  the  ground,  there  arc  three  additional  external  degrees  of  freedom,  a  total 
of  six,  that  specify  Cartesian  position  in  space.  Unlike  the  three  internal  joints  that  are  driven  directly  by 
actuators,  and  therefore  easily  controlled,  die  external  degrees  of  freedom  arc  indirectly  driven  by  dynamic 
interactions  among  the  model,  gravity,  and  the  ground.  At  the  heart  of  the  legged  locomotion  problem  lies 
(lie  need  to  find  ways  to  use  direct  control  of  internal  degrees  of  freedom  to  achieve  indirect  control  of 
external  degrees  of  freedom.  ' 

Basic  operation  of  the  model  is  to  bounce  on  the  springy  leg  in  a  hopping  motion  that  alternates  between 
periods  of  support  and  periods  of  flight.  Four  events  characterize  this  alternating  cycle;  lift-off  -  ihc  moment 
in  die  hopping  cycle  when  the  foot  looses  contact  with  the  ground,  top  -  the  moment  the  body  achieves  peak 
altitude,  touch-down  -  the  moment  the  foot  first  touches  the  ground,  and  bottom  -  the  moment  the  body  has 
minimum  altitude  and  the  leg  is  fully  compressed.  These  four  events  help  to  synchronize  control  to  the 
behavior  of  the  model. 
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3.3.1  Equations  of  motion 

The  3D  hopper  is  modeled  as  an  open  loop  dynamic  linkage.  This  allows  simulation  using  existing  computer 
programs  originally  intended  for  robot  arms  [346].  In  order  to  model  the  hopper  as  an  open  loop  linkage  the 
external  degrees  of  freedom  were  modeled  as  joints  with  zero  mass  and  zero  moment  of  inertia.  The 
kinematics  of  these  joints  arc  described  in  the  Appendix  II. 

The  state  of  the  model  is  described  by  Q  and  Q',  where  Q  is  the  position  vector  describing  the  position  of  each 
of  the  links  and  Q'  is  the  velocity  vector  describing  the  velocity  of  each  of  the  links.  To  obtain  the  equations 
of  motion  we  must  find  the  acceleration  vector  Q"  given  the  state  of  the  model  and  the  forces  acting  at  each 
joint: 

Q"  =  f(Q,Q/,T,g)  (3.1) 

where 

r  is  the  vector  of  torques  that  acts  on  the  internal  joints  of  the  mechanism,  and 
g  is  die  gravitational  vector. 

The  derivation  and  of  the  equations  of  motion  were  described  by  Luh,  Walker,  and  Riul  [192],  and  efficient 
methods  for  solving  them  numerically  were  given  by  Walker  and  Orin  [346J.  We  used  Walker  and  Orin’s  3rd 
method  to  determine  Q". 

Ilic  analysis  is  divided  into  a  set  of  equations  that  describes  the  system  when  it  is  on  the  ground,  and  another 
set  that  describes  the  system  when  it  is  in  flight.  It  is  also  necessary  to  dotetminc  what  happens  at  transitions 
between  these  two  phases.  During  stance  die  machine  is  an  inverted  pendulum  that  can  tip  in  two  directions, 
in  addition  to  rotating  about  its  own  axis.  Ground  forces  resulting  from  impact,  internal  forces  and  torques, 
and  gravity  affect  the  angular  and  linear  momentum  of  the  hopper  during  stance.  In  flight  overall  motion  of 
the  system  is  ballistic,  affected  only  by  gravitational  forces.  The  horizontal  component  of  the  linear 
momentum  and  die  angular  momentum  about  the  center  of  gravity  remain  unaltered  during  flight.  Solution 
of  (3.1)  gives  the  trajectory  of  die  system  as  a  function  of  time,  din  ing  either  stance  or  flight. 

At  the  transition  between  stance  and  flight,  lift-off,  and  between  flight  and  stance,  touch-down,  the  simulation 
has  discontinuities.  At  these  transitions  the  laws  of  conservation  of  momentum  arc  invoked  in  order  to 
determine  changes  in  slate.  If  we  assume  the  ground  to  be  rigid  with  no  compliance,  then  at  touch-down  an 
impulse  force  of  duration  e  acts  on  the  foot.  As  a  result  the  velocities  Q'  arc  changed  while  the  position  Q 
remains  unaltered.  Simulation  of  die  hopper  in  the  ground  phase  requires  calculation  of  die  change  in  Q'. 

The  following  assumptions  arc  made  about  the  nature  of  die  impact. 

r+e/2 

•  Ail  impulse  of  magnitude  5  =  J  F  dt  acts  on  the  foot  at  the  time  of  impact.  No  torques  act 

on  die  foot.  i- c/2 

•  The  force  F  is  very  large  compared  to  other  forces  acting  on  the  system,  such  as  gravity  and 
internal  forces  and  torques. 
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•  The  duration  of  transition  between  phases,  c,  is  very  small. 


Using  generalized  coordinates,  r  is  a  vector  of  forces  and  torques  that  acts  on  the  joints.  Since  angular 
momentum  is  conserved  about  the  z-axis  of  a  rotary  joint  during  impact  and  linear  momentum  is  conserved 
along  the  z-axis  of  a  translational  joint: 


t+e/2 


( 

i-t/i 


t  dt  =  r  e=  J  A  O' 


(3.2) 


By  applying  conservation  of  momentum  about  the  z-axis  of  the  three  external  rotational  joints  and  the  three 
internal  joints  we  get  six  simultaneous  equations: 

9 

Qj  =  U/  for  i  =  4  through  9  (3.3) 

J—i 

where 

Qj  is  the  velocity  at  joint  j. 
a jj  is  a  linear  constant  that  depends  on  Q,  to  Q,. 

If  joint  i  is  rotational  then  l,,  is  the  total  angular  momentum  of  links  i  through  9,  about  the  axis  of  joint  i,  prior 
to  touchdown.  If  joint  i  is  translational  then  L,  is  the  total  linear  momentum  of  links  i  through  9  prior  to 
touchdown. 

Once  tne  state  is  known  at  t-e/2,  (3.3)  can  be  solved  for  die  velocity  vector  after  touch-down.  The  state  at 
1+  e/2  can  then  be  computed  without  knowing  the  impulse  forces  acting  on  die  foot. 

At  lift-off  the  leg  and  body  assume  die  same  velocity,  which  is  the  velocity  of  the  center  of  gravity.  An 
inelastic  collision  between  body  and  leg  is  assumed.  The  effect  of  this  impact  is  calculated  in  a  similar  fashion. 
Conserving  momentum  about  the  remaining  eight  joints  provides  the  velocity  vector  at  lift-off.  This 
procedure  permits  modeling  of  the  transitions  from  flight  to  stance  and  from  stance  to  flight  with  very  little 
computation. 

3.4  Control 

The  strategy  employed  here  to  control  locomotion  of  the  31)  model  is  to  decompose  its  motion  into  a  planar 
part  and  an  extra-planar  part.  There  is  a  pk.nc  diat  contains  the  gravity  vector,  die  center  of  gravity,  and  the 
forward  velocity  vector.  We  call  diis  the  plane  of  motion.  Wc  call  the  line  where  tJiis  plane  intersects  the 
ground  the  line  of  motion.  If  die  control  system  were  always  to  place  the  foot  on  the  line  of  motion,  then  all 
forces  acting  on  die  model  would  lie  in  die  plane  of  motion.  In  that  case  die  machine  would  never  leave  the 
plane  of  motion  and  die  planar  control  system  mentioned  earlier  would  be  adequate  to  regulate  hopping, 
attitude,  and  forward  travel. 
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The  extra-planar  control  part  corrects  three  types  of  errors  introduced  by  external  disturbances  and  noisy 
control.  These  errors  are  roll  rotation,  yaw  rotation,  and  lateral  translation.  Corrections  for  roll  error  are 
made  by  the  attitude  control  algorithm,  much  as  pitch  corrections  are  made.  Yaw  errors  are  corrected  by 
placing  the  foot  outside  the  plane  of  motion,  and  applying  suitable  hip  torque  during  stance.  Lateral 
translations  arc  not  actually  corrected  in  the  present  scheme,  but  they  arc  taken  into  account  when  the  plane 
of  motion  is  redefined  on  each  step.  The  planar  control  part  operates  properly  in  3D  only  when  the  extra- 
planar  part  successfully  limits  each  of  these  error  motions  to  small  magnitude. 

By  augmenting  the  planar  3-part  ccntroP"r  with  additional  extra-planar  controls,  we  arrive  at  a  3D  control 
system  with  4  separate  control  algorithms.  They  control  hopping  height,  forward  velocity,  body  attitude,  and 
spin. 

3.4.1  Height  control 

Control  of  hopping  height  for  the  2D  case  has  been  explored  elsewhere  in  simulation  and  physical 
experiments  1284,  286,  287),  Simple  control  of  hopping  height  is  a  ID  problem  that  is  substantially  the  same 
for  locomotion  in  2  and  3D.  Therefore  we  have  simplified  the  present  model. 

'Hie  simulation  o'*  the  hopper  docs  not  incorporate  die  various  losses  that  occur  due  to  friction  in  the  actual 
machine.  The  only  losses  that  occur  are  due  to  impact  at  touch-down  and  lift-off.  Therefore,  very  little  has  to 
be  done  to  maintain  correct  hopping  height  once  it  is  attained. 

3.4.2  Velocity  control 

The  primary  mechanism  used  for  controlling  the  velocity  of  the  hopper  is  proper  placement  of  the  foot  at 
touch-down.  During  flight  the  control  system  orients  the  leg  so  as  to  position  die  foot  with  respect  to  the 
center  of  the  CG-print.  The  algorithm  is  described  below. 

At  touch-down: 

lfl=mrxv  +  Lc?  =  mvr sin (<?„  -  0:)  4-  Lcg  (3.4) 

where- 

L0  is  the  angular  momentum  of  the  model  about  die  point  of  touch-down, 

Lcg  is  the  angular  momentum  of  die  model  about  its  own  center  of  gravity, 

r  is  die  vector  from  the  point  of  touch-down  to  die  center  of  gravity  of  die  model, 

v  is  die  velocity  of  the  center  of  gravity, 

m  is  die  combined  mass  of  the  body  and  leg, 

is  die  angle  formed  by  the  gravity  vector  and  v,  and 
0l  is  the  angle  formed  by  the  gravity  vector  and  r. 

See  Fig.  3-2. 


POINT  OF  TOUCHDOWN 
Figure  >2:  Configuration  of  model  in  plane  of  motion. 

Wc  make  the  assumption  that  r,  v,  and  the  gravity  vector  lie  in  the  same  pl  ane.  The  first  term  in  (3.4)  is 
dependent  on  the  placement  of  the  foot.  It  determines  whether  the  system  tips  forward  or  backward  after 
touch-down.  During  the  normal  hopping  cycle,  the  horizontal  velocity  at  touch-down  is  large  and  the  angular 
momentum  about  the  center  of  gravity  is  small.  The  major  component  of  the  angular  momentum  is  the  first 
term. 

During  stance  the  change  in  angular  momentum  is: 

lift-off  t ft- off  Ift-off 

aL=  /  rxmgdt  =  /  mgrsin(0)dt=  /  m  g r s\n{6)&0/Q'  (3.5) 

touch-down  touch-down  touch-down 


where  g  is  the  gravitational  acceleration  vector. 

The  change  aL  is  a  nonlinear  function  of  6{] ,  0,.v.  r(t)  and  0(t).  Its  exact  evaluation  would  require  solution  of 
the  equations  of  motion  for  the  stance  phase.  Wc  have  no  closed  form  solution.  Data  generated  by  a 
systematic  set  of  simulations  for  a  large  range  of  initial  conditions  are  shown  in  Fig.  .3-3.  They  show'  that  the 
relationships  between  lift-off  velocity,  on  the  one  hand,  and  touch-down  velocity,  vertical  velocity,  and  leg 
angle,  on  the  other  hand,  arc  all  nearly  linear  over  a  wide  range  of  values.  Wc  have  used  the  linear 
approximation  for  control  with  good  success. 

Figure  3-4  shows  tire  trajectory  of  the  center  of  gravity  as  a  function  of  time  when  this  control  is  used.  A 
constant  desired  velocity  was  specified  until  the  model  had  translated  2  m.  at  which  point  the  desired  velocity 
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Figure  3-3:  The  effect  of  foot  placement  on  forward  velocity  was  determined 

empirically  by  simulating  stance  for  a  set  of  initial  conditions  and  foot  placements. 

Once  foiward  velocity  is  known,  it  is  possible  to  use  these  data  to  select  a  foot 

placement  that  will  change  the  forward  velocity  to  a  desired  value.  The  data  in  this 

figt.'-e  ore  for  /  ,  .  =1  m/scc. 

°  cg.touch-down 


was  brought  to  zero.  Average  velocity  was  controlled  with  good  precision.  The  temporary  deviations  from 
the  average  velocity  visible  in  the  piot  were  caused  by  the  attitude  control  servo,  which  begins  to  erect  the 
body  right  after  touch-down. 


3.4.3  Attitude  co'itroi 

During  stance  it  is  possible  to  fake  advantage  of  friction  between  the  foot  and  the  ground  to  generate  hip 
torques  that  will  erect  the  body.  I  he  attitude  controller  must  correct  errors  in  both  pitch  and  roll.  Roll  errors 
will  generally  be  small  while  pitch  errors  arc  large.  Pitch  errors  arc  caused  by  ihc  reaction  of  the  body  to  the 
swinging  motion  of  the  leg  made  when  die  foot  is  swung  forward  in  preparation  for  the  next  step.  Roll  errors 
arc  caus'd  by  disturbances. 
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The  attitude  controller  is  a  linear  PD  servo  that  is  neither  too  stiff  nor  too  soft.  It  must  be  stiff  enough  to  have 
settled  by  the  end  of  stance.  If  this  is  not  so  the  servo  will  disturb  the  body’s  attitude  at  lift-off,  rather  than 
correct  it.  Hie  servo  must  not  be  so  sdff  that  it  causes  the  foot  to  slip  when  it  generates  hip  torques.  The 
weight  of  the  system  and  the  coefficient  of  friction  of  the  foot  arc  the  limiting  factors.  Independent  servo 
controllers  arc  used  about  both  the  pitch  and  roll  axes,  each  with  {  » .707. 

Tpitch  ”  "  ^P^plich "  *Ppitch,d) '  pitch  (3.6) 

«  %  . 

rroll=  '  VVro//*  9 roll J  *  roll  *  (3-7) 


where 

Tpiich’  Troll 
Tpitch'  Troll 

Tpitch.d’  Troil,d 
ltp.  k^ 


arc  the  torques  applied  at  the  pitch  and  roll  axes, 

.■’re  the  pitch  and  roll  angles  of  the  body, 

are  the.  desired  pitch  and  roll  angles  of  die  body  at  lift-off,  and 

are  the  proportional  and  derivative  feedback  gains. 


'Hie  fourth  curve  in  Fig.  3-4  is  a  plot  of  body  pitch  angle  and  the  leg  angle  as  a  function  of  time  during 
constant  velocity  running.  The  body  tilts  forward  in  the  night  phase  as  die  leg  swings  forward.  At  touch¬ 
down  the  body  angle  reaches  a  maximum.  During  stance  die  controller  forces  the  body  angle  toward  zero. 
Roll  motions  arc  similarly  corrected. 


3.4.4  Spin  control 

The  control  system  suppresses  spin  by  placing  die  foot  outside  of  the  plane  of  motion.  Fore  and  aft  forces  on 
die  foot,  generated  both  by  the  foot’s  impact  during  touch-down  and  by  hip  torque  during  stance,  produce  a 
torque  about  the  yaw  axis  when  the  foot  is  placed  outside  of  die  plane  of  motion.  Let  the  distance  of  the  foot 
from  the  plane  of  motion  be  dj_.  On  touch-down  an  impact  torque  causes  a  change  in  spin  momentum: 

m*hon  (3.8) 

where  is  the  angular  momentum  about  the  yaw  axis. 

In  this  equation  mvterz  is  the  linear  momentum  of  the  hopper  in  the  direction  of  die  line  of  motion,  and  d  j_is 
the  horizontal  distance  between  the  center  of  gravity  and  the  point  of  touch-down  in  a  direction 
perpendicular  to  die  plane  of  motion. 

When  a  hip  torque  is  applied  to  die  body  about  the  axis  perpendicular  to  the  plane  of  motion,  it  causes  a 
ground  reaction  force  at  die  base  of  the  foot  in  the  direction  of  the  line  of  motion. 

horz  —  T hip  x  r  cosO  (3.9) 


where  0  is  the  angle  between  r  and  g. 


This  force  causes  a  torque  to  act  about  a  vertical  axis  through  the  center  of  gravity.  The  total  change  in  the 
spin  angular  momentum  during  stance  is: 
lift-off 

=  (3.10) 

touch-down 
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Figure  J-5:  Spin  control.  Top:  Angular  position  about  the  jaw  axis  is  plotted  as  a 
function  of  time  for  various  initial  spin  rates,  The  spin  velocity  is  suppressed  in  a 
short  time  for  initial  spin  rates  of  up  to  .2  rad/sec.  Bottom:  Path  followed  by  center  of 
gravity  while  spin  is  suppressed.  Spin  suppression  places  the  foot  outside  the  plane  of 
motion,  with  the  side-effect  of  altcnna  the  direction  of  travel. 

Figure  3-5  (top)  plots  spin  about  the  yaw  axis  as  a  function  of  time  for  four  different  initial  spin  rates.  For 
initial  rates  of  .2  rad/scc  or  less,  spin  is  quickly  controlled.  The  present  technique  docs  not  work  when  the 
spin  late  exceeds  0.2  rad/scc.  For  instance,  at  an  initial  spin  rate  of  .25  rad/scc  oscillations  in  the  spin  occur 
that  cause  the  body  to  go  unstable.  Figure  3-5  (bottom)  shows  die  path  followed  by  the  hopper  during  the 
spin  suppression  maneuver.  Placement  of  die  foot  outside  the  plane  of  motion  to  correct  spin,  has  the 
side-effect  ofehanging  the  direction  of  travel. 

The  various  controllers  may  require  conflicting  actions  to  achieve  their  goals.  There  are  two  eases  where  this 
is  apparent.  First,  spin  control  may  require  die  foot  to  be  placed  at  a  large  distance  from  die  plane  of  motion. 
However  if  dj_  is  large  die  trajectory  in  die  plane  of  motion  is  affected.  Care  should  be  taken  to  see  that 
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sin-l(dj_/|r|)<<  6X.  Second,  spin  control  may  require  certain  body  torques  to  be  applied  according  to 
(3.10).  However  correction  of  body  pitch  errors  may  require  that  other  torques  be  applied.  Priority  is  given 
to  control  of  spin.  Correction  of  the  body  angle  can  be  deferred  to  a  later  time. 


Figure  3*6:  Path  control.  The  3D  model  was  made  to  follow  a  square  path.  It  started 
at  (1,-1),  lower  right,  and  progressed  clockwise  through  (-1,-1),  (-1,1),  and  (1,1),  finally 
returning  to  the  starting  point.  (Grid  spacing  is  0.2  m.  Center  is  (0,0).)  The  upper 
trace  marks  the  path  of  the  center  of  gravity.  Ihc  lower  trace  marks  the  path  of  the 
foot.  Total  time  around  the  square  was  24  see. 


3.4.5  Path  control 

The  control  algorithms  just  described  can  be  lin'd  to  get  a  simple  form  of  path  control.  If  a  desired  path  is 
decomposed  into  a  set  of  straight  line  segments,  then  the  path  can  be  followed  by  stopping  die  machine  at 
each  vertex  and  changing  its  direction  of  travel.  The  plane  of  motion  is  not  uniquely  defined  when  there  is  no 
forward  travel,  so  die  control  system  is  free  to  choose  the  piane  that  includes  die  next  straight  path  segment. 
Figure  3-6  shows  a  cartoon  of  the  one-legged  machine,  and  die  trajectory  it  look  in  traversing  a  square  path. 
Hie  settling  time  at  each  vertex  made  progress  quite  slow,  about  24  see  for  the  circuit,  but  the  accuracy  of  the 
path  was  reasonably  good. 
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Even  for  the  simple  case  of  a  one-legged  system,  the  algorithms  presented  here  are  not  yet  complete  solutions 
to  the  3D  locomotion  control  problem.  First,  we  do  not  yet  know  how  to  change  heading  while  running.  In 
order  to  change  the  direction  of  travel,  the  existing  control  system  brings  the  machine  to  a  halt,  selects  a  new 
direction,  and  then  accelerates.  It  would  be  very  tedious  to  follow  a  winding  contour  using  this  approach. 
Second,  choosing  the  plane  of  motion  to  incorporate  lateral  velocity  errors  permits  the  system  to  balance 
using  the  planar  algorithms,  but  errors  in  heading  cannot  be  corrected  once  travel  starts.  Yaw,  roll,  and  lateral 
velocity  errors  will  all  contribute  to  heading  drift.  'Hurd,  these  algorithms  depend  on  a  system  that  can  travel 
equally  well  in  all  directions.  Although  it  is  possible  to  change  heading,  the  algorithms  provide  no  way  to 
change  the  machine’s  facing  direction. 

Another  consideration  is  that  these  algorithms  have  only  been  tested  in  simulation.  We  are  in  the  process  of 
testing  them  on  a  physical  3D  one-legged  system. 

3.5  Conclusion 

I  .egged  locomotion  is  a  largely  planar  activity  that  takes  place  in  3D  space.  We  argue  that  such  behavior  can 
be  accomplished  by  providing  one  set  of  control  algorithms  that  balance  and  generate  travel  within  a  plane, 
and  a  second  set  of  control  algorithms  the  eliminate  motions  that  deviate  from  dial  plane.  Control  within  die 
plane  of  motion  can  be  further  decomposed.  The  entire  system  consists  of  four  control  algorithms: 

*  Height:  The  springy  leg  is  driven  to  cause  hopping  oscillations  of  the  machine.  Hopping  height  is 
regulated  by  using  a  measurement  of  the  system’s  vertical  energy  to  determine  the  correct  amount 
of  thrust. 

*  Forward  velocity:  'Hie  CG-print  is  the  locus  of  points  over  which  the  machine’s  center  of  gravity 
will  travel  during  the  next  stance  period.  The  control  system  regulates  forward  velocity  by 
manipulating  placement  of  the  foot  relative  to  the  center  of  die  CG-print. 

•  Attitude:  During  stance  when  friction  holds  the  foot  in  place,  hip  torque  is  used  to  erect  die  body. 

Fitch  and  roll  angles  arc  both  corrected  with  a  linear  PD  servo. 

•  Snin:  The  foot  is  placed  outside  of  die  plane  of  motion  and  a  torque  is  generated  at  the  hip.  This 
produces  a  torque  about  die  yaw  axis  that  retards  spin  motion. 

Simulation  data  showing  effective  forward  velocity  control,  spin  suppression,  and  straight  segment  path 
control  encourage  us  to  further  tost  die  feasibility  of  these  ideas  with  a  set  of  physical  experiments. 
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3.6  Appendix  II.  Description  of  3D  Model 


Dimensions  of  3D  one-legged  model: 


Link 

leg 

cylinder 

ring 

body 

Units 

Description 

Cylinder 

Cylinder 

Ring 

Ring 

Mass 

.8626 

0.5902  . 

0.1 

14.755 

Kg 

Length 

0.8 

0.15 

0.01 

Meters 

Radius  0.01 

Moments  oflnertia: 

0.02 

0.03 

0.3 

Meters 

0.0474 

0.00674 

0.00009 

1.152 

Kg-m2 

Jyy 

0.0474 

0.0004 

0.000046 

0.807 

Kg*m2 

0.0001  . 

0.00674 

0.000046 

0.115 

Kg-m2 

Jxy 

0 

0 

0 

0 

Kg-m2 

J>, 

0 

0 

0 

0 

Kg-m2 

0  . 

0 

0 

0 

Kg-m2 

Denavit-Hartenberg  description  of  the  model: 


Joint# 

e 

d 

a 

a 

Description 

1 

-tt/2 

Qi 

0 

7t/2 

External  degree  of  freedom.  X  displacement  of  foot. 

2 

it/  2 

Q-, 

0 

tt/2 

External  degree  of  freedom.  Y  displacement  of  foot 

3 

tt/2 

Qj 

0 

tt/2 

External  degree  of  freedom.  7.  displacement  of  foot. 

4 

Qt 

0 

0 

tt/2 

External  degieo  of  freedom.  Orientation  of  leg. 

5 

0 

0 

.tt/2 

External  degree  of  freedom.  Orientation  of  leg. 

6 

0 

0 

0 

External  degree  of  freedom.  Orientation  of  leg. 

7 

7r/2 

q7 

0 

tt/2 

Length  of  leg. 

8 

0 

0 

n/2 

Orientation  of  leg  with  respect  to  hip. 

9 

0 

0 

tt/2 

Orientation  of  leg  with  respect  to  hip. 

45 


4.  Design  and  Construction  of  3D  One-Legged 
Machine 

4.1  Introduction 

Wc  have  designed  and  built  a  3D  one-legged  hopping  machine  to  enable  experiments  on  legged  systems  that 
balance  in  3-spacc.  Figure  4-1  is  a  diagram  of  the  machine,  and  a  photograph  is  shown  in  Fig.  e-3.  The 
machine  is  largely  a  generalization  of  the  2D  hopper  described  in  chapter  2.  It  includes  a  leg  that  changes 
length,  a  body  that  carries  sensors  and  interface  electronics,  and  an  actuated  2-axis  hip.  The  machine  has  an 
overall  height  of  43.5  inches  (1.10  m)  and  a  mass  of  38  lbs.  (17.3  kg).  Appendices  III  and  IV  give  a  detailed 
specification  of  the  machine  along  with  comparable  data  for  the  2D  hopper. 

The  leg  consists  of  a  double  ended  air  cylinder  with  a  foot  at  one  end  and  a  length  sensor  at  die  other  end.  Air 
pressure  applied  to  the  top  of  the  cylinder  causes  the  piston  and  rod  to  extend  downward  against  the  floor 
providing  an  upward  thrust  to  the  body  of  die  machine.  When  the  valves  seal  off  the  cylinder,  trapped  air 
makes  the  leg  springly  along  it’s  long  axis.  A  cushioned  foot  at  the  lower  end  of  the  cylinder  rod  softens 
impacts  of  the  foot  with  the  floor,  and  provides  good  traction.  Two  hydraulic  actuators,  oriented  at  90°  to  one 
another,  drive  motion  of  the  leg  widi  respect  to  the  body.  They  attach  to  die  center  portion  of  die  leg  just 
below  die  hip. 

Three  major  design  decisions  were  made  early: 

•  The  machine  would  not  carry  its  own  power  supplies  nor  its  own  computing. 

•  The  machine  would  have  only  one  leg. 

•  T  he  leg  would  be  similar  to  die  one  used  on  die  2D  hopping  machine. 

•  The  machine  would  have  no  preferred  direction  of  travel. 

Wc  decided  early  on  not  to  build  a  self  contained  machine.  Therefore  die  hydraulic  and  pneumatic  power 
supplies  are  mounted  off-board  and  connected  to  the  machine  through  a  flexible  umbilical  cable.  The  control 
computer  is  located  in  the  next  room,  and  communicates  digitally  through  a  ribbon  cable.  The  design  effort 
required  to  mount  power  sources  and  computing  on  board  would  Invc  distracted  us  Horn  our  main  objective 
of  studying  balance  and  dynamic  control. 

There  were  four  reasons  why  wc  decided  to  build  a  3D  machine  with  only  one  leg.  Fust.  't  is  simpler  to  study 
balance  in  machines  with  one  leg,  because  coupling  between  legs  does  not  have  to  be  understood  and 
controlled.  It  is  also  easier  to  focus  on  balance,  because  it  is  such  an  important  problem  for  a  one-legged 
machine  that  cannot  provide  itself  with  a  tripod  of  static  support.  Second,  we  wanted  to  build  as  little 
equipment  as  possible.  More  equipment  means  more  construction  time,  more  down  time,  and  less  reliable 


46 


Figure  4*1:  Diagram  of  3D  one-legged  machine  that  was  built.  The  leg  is  connected 
to  the  body  by  a  two  axis  gimblc  hip.  Two  hydraulic  actuators  control  the  orientation 
of  the  leg  with  respect  to  the  body.  The  leg  is  a  pneumatic  cylinder  with  a  padded 
load-sensing  fool  at  one  end.  and  a  linear  potentiometer  at  the  other  end.  The  foot 
measures  3  forces  acting  between  it  and  the  ground.  The  body  is  made  of  an 
aluminum  frame  within  which  are  mounted  computer  interface  electronics,  valves,  a 
gyroscope,  and  an  electronic  compass. 

operation.  The  machine  described  here  has  only  three  actuators,  one  leg,  one  foot,  and  about  a  dozen  sensors. 
Third,  the  behavior  of  a  one-legged  device  is  fundamentally  similar  to  the  behavior  of  each  leg  in  multi-lcggcd 
systems.  Therefore  study  of  a  one-legged  machine  provides  knowledge  that  helps  to  understand  all  sorts  of 
dynamic  legged  systems.  Fourth,  v/e  wanted  to  apply  what  we  learned  in  die  2D  case  to  the  3D  case, 
generalizing  the  designs,  the  algorithms,  and  the  concepts  as  needed, 

Wc  sec  the  need  to  turn  and  to  control  motions  during  turning  as  very  complicated  activities  which  we  wanted 
to  avoid.  A  machine  without  a  preferred  axis  docs  not  have  to  change  its  heading  to  change  its  direction  of 
travel.  It  is  also  less  encumbered  by  uncontrolled  spin,  since  the  machine  can  continue  making  progress  in  die 
desired  direction,  even  if  the  machine  changes  its  heading  on  each  hop.  A  symmetrical  machine  should  be 
easier  to  control. 
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Figure  4*2:  A  bottom  view  of  the  hip.  The  two  hydraulic  actuators  position  the  leg 
with  respect  to  the  body.  Each  actuator  is  provided  with  a  position  sensor,  a  velocity 
sensor,  and  a  flow  control  se'-vo  valve.  The  arrangement  of  actuators  and  linkages 
provides  •+. 30  leg  motion  about  one  as  is,  and  ±.20°  about  the  other. 


4.2  Design  Details 

'Hie  leg  is  very  similar  in  design  to  that  used  on  the  2D  hopper.  The  choice  of  leg  equipment  was  an  act  of 
conservatism:  there  was  no  reason  to  improve  on  the  leg  used  in  the  2D  machine,  since  it  worked  very  well. 
The  air  cylinder  is  identical  to  that  of  the  2D  hopper,  except  that  die  bore  was  increased  from  1-1/8  inch  (28.6 
mm)  to  1-1/2  inch  (38.1  mm)  while  die  stroke  remains  the  same  at  10  inches  (254  mm).  The  full  actuator 
stroke  will  not  be  used  during  normal  hopping,  but  will  permit  retracting  the  leg  to  prevent  damage  in  crash 
situations. 

The  system  is  designed  to  operate  on  90  psig  (620  kPa)  compressed  air,  which  is  available  in  our  laboratory. 
The  11%  increase  in  cross-sectional  area  of  die  cylinder  should  make  die  vertical  hopping  performance  close 
to  that  of  the  2D  hopper,  with  die  weight  increase  from  19  to  38  lb.  (88  to  170  N).  The  cylinder  rod  diameter 
was  increased  from  3/8  to  1/2  in.  (9.5  to  12.7  mm),  which  should  make  die  rod  much  less  vulnerable  to 
bending.  The  double-ended  rod  configuration  provides  two  widely  spaced  rod  bearings  to  minimize  binding 
and  wear.  Control  of  die  vertical  dirust  is  by  means  of  four  normally-closed  solenoid  driven  air  valves.  They 
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permit  each  end  of  the  air  actuator  to  be  connected  to  supply  pressure,  room  pressure,  or  to  be  sealed.  A 
linear  potentiometer,  housed  at  the  top  end  of  the  vertical  air  cylinder,  senses  the  position  of  a  wiper  attached 
to  the  top  end  of  the  actuator  rod.  It  provides  a  measurement  of  the  length  of  the  leg. 

We  chose  hydraulic  power  to  drive  motions  of  the  hip,  rejecting  pneumatic  and  electric  power.  'A  design  goal 
was  that  the  hip  actuators  should  be  able  to  swing  the  leg  through  a  full  60°  motion  in  about  100  msec. 
Calculations  were  based  upon  a  constant  acceieration/dcccleration  trajectory,  the  theoretical  optimum  for 
force-limited  actuators.  For  high-performance  electric  servo  motors,  reasonable  power-to-weight  ratios  can 
be  obtained  only  at  high  rotational  speeds.  Thus  the  power  delivered  to  the  load  was  limited  by  the  inertia  of 
the  motor  and  gearing.  We  concluded  that  our  application  would  require  an  excessively  heavy  actuator 
package.  Klectric  actuators  become  even  less  attractive  as  a  legged  system  scales  to  larger  sizes. 

We  also  decided  not  to  use  pneumatic  power,  even  though  it  had  worked  reasonably  well  in  the  2D  machine. 
Air  power  has  two  sets  of  limitations,  one  involving  servo  compliance,  die  other  involving  energy  efficiency. 
Since  air  is  compressible,  air  servos  cannot  be  made  very  stiff  without  operating  at  high  pressure.  However, 
high  pressure  compressed  air  is  not  readily  available,  even  at  moderate  flow  rates.  Pneumatic  servo  valves 
also  have  limitations:  Single  stage  valves  consume  large  amounts  of  compressed  air,  much  of  which  is  dumped 
to  aunospherc  when  no  motion  is  required.  Two-stage  pneumatic  servo  valves,  although  more  efficient,  are 
generally  vulnerable  to  contaminants  in  die  air  and  provide  relatively  poor  frequency  response.  Of  course, 
pneumatics  has  the  advantage  that  it  is  easy  to  clean  up  after  leaks. 

On  the  basis  of  die  design  target,  a  hydraulic  actuator  displacement  of  0.2  in3  @1000  psi  (3.3  cm3  @7.0  mPa) 
was  needed.  With  a  servo  valve  rated  for  0.5  gpm  @1000  psi  (32  cnvVscc  @7.0  mPa)  pressure  drop,  the 
specified  performance  could  be  obtained  at  a  supply  pressure  of  2000  psi  (14  mPa).  We  selected  a  double- 
ended  actuator  with  0.2  in2  (1.3  cm2)  cross-scctional  area,  5/8  in.  (14.9  mm)  bore,  3/8  in.  (9.5  mm)  rod,  a  1 7/8 
in.  (47.6  mm)  stroke.  The  choice  allowed  us  to  use  available  actuators,  and  to  minimize  the  bearing  load  at 
die  hip  by  keeping  the  attachment  point  of  die  actuator  to  the  leg  a  reasonable  radius  from  the  hip  joint.  It 
provides  approximately  twice  the  desired  displacement.  The  double-ended  rod  configuration  provides  equal 
areas  on  both  sides  of  the  piston  for  symmetrical  performance.  The  extra  rod  is  used  to  operate  position  and 
velocity  transducers.  A  two-stage  servo  valve  with  a  rating  of  1  gpm  @  1000  psi  (63  emVscc  @7.0  mf'a)  was 
selected  to  match  die  actuator  characteristics.  rllie  hydraulic  power  supply  and  all  system  components  are 
ratal  @3000  psi  (21  mPa). 

The  two  actuators  that  drive  die  hip  arc  built  as  complete,  modular  units.  Sec  Fig.  4-3.  Kach  actuator  is 
equipped  with  a  linear  potentiometer  and  a  linear  tachometer,  to  provide  position  and  velocity  measurements 
on  both  axes.  The  body  of  each  transducer  attaches  directly  to  the  body  of  each  hydraulic  actuator,  with  the 
sensor  rods  connected  to  the  unused  rod  of  the  actuator.  The  servo  valves  arc  mounted  directly  on  the 
cylinders  for  maximum  response. 


The  original  goal  was  to  design  a  machine  that  was  symmetrical  about  the  vertical  axis.  However,  design 


considerations  dictated  a  compromise  in  this  plan.  Ideally,  the  two  actuators  would  act  nominally  at  right 
angles  to  the  lever  ann  from  the  hip  joint,  and  the  body  pivot  of  each  actuator  would  be  in  the  plane  of  the 
hip  joint.  To  meet  these  requirements,  the  rod-end  pivot  points  of  the  horizontal  cylinders  must  pass  through 
the  body  of  the  leg  cylinder.  A  rather  complex  mechanism  is  required  to  satisfy  this  requirement,  if  it  is  to 
accommodate  the  full  motion  of  the  leg  when  actuated  about  both  axes  simultaneously.  The  problem  is 
aggravated  when  both  pivot  points  must  be  at  die  same  radius  from  the  hip.  The  design  was  greatly  simplified 
by  placing  die  fore-aft  actuator  in  the  preferred  configuration,  while  the  attachment  of  the  other  actuator  was 
moved  outside  of  the  body  of  die  leg,  and  below  the  pivot  point  of  the  other  actuator.  Because  of  the  hip 
gimbal  geometry,  leg  rotation  was  seen  only  by  the  side-to-sidc  actuator;  this  was  accommodated  by  a 
spherical  rod-end  bearing.  This  design  allows  the  desired  ±.30°  swing  in  die  fore-aft  direction,  with  .±20° 
movement  sidc-to-side. 

Several  hip  designs  were  considered  to  provide  the  required  two  degrees  of  freedom.  Ruggedness,  minimum 
weight,  and  friction  were  primary  considerations.  The  need  for  the  structure  of  the  leg  to  pass  through  the  hip 
joint  precluded  the  use  of  a  through  shaft  at  the  pivots,  and  necessitated  a  relatively  large  mechanism.  We 
considered  placing  die  body  of  the  leg  cylinder  below  die  hip,  but  decided  this  was  not  consistent  with  the 
desired  stroke  length  and  a  hip  height  of  23  inches  (0.58  m).  A  ball-and-socket  joint  encircling  the  leg 
cylinder  was  considered,  but  rejected  due  to  large  size,  weight,  high  friction,  and  difficulty  in  manufacturing. 
No  reasonable  flexure  arrangement  using  metals,  plastics,  or  elastomers  was  evident  which  would  meet  the 
required  range  of  motions  and  provide  the  rigidity  and  strength  needed  for  precise  ontrol.  Based  on  these 
considerations,  a  gimbal  arrangement  was  selected.  This  mechanism  uses  two  sets  of  pivots  arranged  at  90°, 
and  an  intermediate  floating  ring  to  connect  the  two. 

The  body  frame  of  the  machine  was  designed  as  a  cage  that  encloses  and  protects  the  machine  components. 
Light  weight  aluminum  tubing  was  formed,  machined,  and  held  in  a  jig  while  all  joints  were  welded.  The 
overall  diameter  of  30  inches  (0.76  m)  was  dictated  by  the  required  radius  for  the  hip  actuators.  The  frame 
must  be  strong  and  rigid  enough  to  withstand  horizontal  actuator  forces  of  400  lbs.  (1800  N)  without 
substantial  deflection.  While  the  frame  is  relatively  large  and  rugged,  it  comprises  only  about  15%  of  the 
machine’s  total  weight.  The  cage  will  protect  die  machine  when  it  falls  over,  and  provide  handling  points,  ft 
also  permits  the  addition  of  weights  to  adjust  die  center  of  mass  and  moments  of  inertia  as  desired.  Finally, 
the  frame  tubing  provides  a  space  for  storage  of  compressed  air,  supplied  through  the  umbilical,  to  maximize 
the  leg’s  responsiveness. 

4.3  Sensors 

Roll,  pitch  and  yaw  angles  must  be  known  diroughout  dir  mg  cycle  in  order  to  control  the  machine.  A 
2-axis  vertical  gyro  measures  roll  and  pitch  angles  of  die  bo  . .  A  magnetic  flux  sensor  provides  information 
that  indicates  yaw  angle.  These  instruments  arc  relatively  fragile  and  will  have  to  be  properly  mounted  and 
protected  from  the  shock  of  normal  hopping,  and  die  shock  of  a  crash.  It  is  uncertain  how  these  instruments 
will  behave  under  the  continual  vertical  accelerations  that  occur  during  hopping.  We  anticipate  that  the 
attitude  measurement  problem  will  be  one  of  die  most  challenging  problems  in  achieving  3D  control. 
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Force  sensing  is  incorporated  in  the  design  of  the  foot.  Force  sensing  will  be  useful  in  the  measurement  and 

control  of  the  foot  thrust  and  side  forces,  and  may  enable  detection  of  foot  slippage  or  impending  loss  of 

traction.  A  single-axis  load  cell  tin  the  thrust  direction)  has  been  built  using  a  four-strain-gauge  bridge  at  the 

foot.  Preliminary  tests  indicate  that  this  load  cell  will  provide  reasonable  measurements  of  the  foot  thrust  as 

well  as  a  clear  indication  of  the  time  of  touch-down.  A  3-axis  load  cell  is  being  built  using  12  strain  gauges.  It 

will  have  integral  instrumentation  amplifiers  in  the  foot  to  provide  a  high-level,  low-noise  signal.  The 

force-sensing  foot  may  be  supplemented  by  pressure  sensors  on  the  three  actuators. 

* 

All  communications  between  the  3D  hopper  and  the  control  computer  arc  digital.  Onboard  interface 
electronics  provides  analog  to  digital  conversion  for  sensors,  digital  to  analog  conversion  for  actuators,  digital 
outputs  for  the  air  valves,  and  appropriate  multiplexing. 

4.4  Auxiliary  Equipment 

In  addition  to  the  hopping  machine  itself,  we  have  designed  and  constructed  a  tether  boom,  similar  to  that 
used  with  the  2D  hopper.  Hie  tether  constrains  the  machine  to  move  on  an  circle  of  8  foot  (2.5  rr.)  radius. 
The  arm  itself  is  constnicted  as  a  space  frame  of  light-weight  aluminum  tubing,  and  adds  only  about  1.7  lb 
(0.75  kg)  to  the  effective  mass  of  the  hopper.  The  fixed  end  of  the  tether  boom  attaches  to  a  pivot  post  that 
provides  three  degrees  of  freedom:  pitching  about  the  axis  of  the  arm.  vertical  translation  of  the  machine,  and 
horizontal  translation.  Individual  degrees  of  freedom  can  be  selectively  locked  at  the  pivot  end  of  the  arm  to 
permit  various  operating  modes.  Initially  the  machine  will  operate  only  in  die  vertical  mode,  to  permit  testing 
and  refinement,  of  die  vertical  control  algorithms.  Then  the  machine  will  operate  as  a  2D  hopper  to  allow 
individual  testing  and  tuning  of  die  two  horizontal  control  systems.  Ultimately,  the  machine  will  be  released 
from  die  tether  and  operate  in  3D.  Use  of  diis  tether  mechanism  will  make  it  easier  to  isolate  control 
problems  systematically,  and  to  refine  control. 

The  umbilical  cable  will  be  large,  and  may  cause  problems  when  operating  in  3D.  It  will  include  two 
hydraulic  lines,  one  air-hose,  wires  for  computer  signals,  and  an  electrical  power  cable.  During  3D  operation, 
die  umbilical  must  pcmiit  die  machine  to  move  substantial  distances  in  both  horizontal  directions  without 
applying  large  torques  about  roll,  pitch,  or  yaw  axes.  Enginccthig  of  suitable  support  mechanisms  for  the 
umbilical  is  a  challenge  that  awaits  experience  with  the  operational  machine. 


4.5  Appendix  ill.  Specifications  for  3D  and  2D  One-Legged  Machines, 
Metric  Units 


Parameter 

3D  Hopper 

2D  Hopper 

Overall  Height 

Overall  Width 

Hip  Height 

Total  Mass  (Body  &.  Leg) 

Unsprung  Leg  Mass 

1.10  m 

0.76  tn 

0.58  m 

17  Kg 

0.91  kg 

0.69m 

0.97  m 

0.50  m 

8.6  kg 

0.45  kg 

Ratio:  Body  Mass  to 

18:1 

19:1 

Unsprung  Leg  Mass 

Body  Moment  of  Inertia 

Leg  Moment  oflucrda 

0.709  kg-m2 

0.111  kg-m2 

0.520  kg-m2 

0.037  kg-m2 

Ratio:  Body  Moment  of  Inertia  to 

6.4:1 

14:1 

Leg  Moment  of  Inertia 

Lee  Vertical  Motion 

Stroke 

Ideal  No-Load  Stroke  Time 

Static  Force 

0.25  m 

0.031  s  @620  kPa 

630  N  @620  kPa 

0.25  m 

0.040  s  @620  kPa 
360  N  @620  kPa 

Ratio:  Static  Force  to  Weight 

3.7:1 

4.2:1 

Theoretical  Max.  Work  per  Stroke 

160  N-m 

90  N-m 

Lee  Swccn  Motion 

Sweep  Angle 

Ideal  No-Load  Sweep  Time 

Static  Torque 

Theoretical  Max.  Work  per  Stroke 

1.00  rad/0.71  rad 

0.069  s  @14  mPa 

90  N-m/ 136  N-m  @14mPa 

83  N-m 

0.66  rnd 

0.010  s  @620  kPa 
27  N  in  @620  kPa 

15  N-m 

4.6  Appendix  IV.  Specifications  for  30  and  2D  One-Legged  Machines, 

English  Units 

Purumeter 

3D  Hopper 

2D  Hopper 

Overall  Height 

.  43.5  in 

27.3  in 

Overall  Width 

30.0  in 

38.0  in 

Hip  Height 

23.0  in 

19.5  in 

Total  Mass  (Body  &  Leg) 

38  Ibm 

19  Ibm 

Unsprung  Leg  Mass 

2.0  ibm 

1.0  Ibm 

Ratio;  Body  Mass  to 

18:1 

19:1 

Unsprung  Leg  Mass 

Body  Moment  of  Inertia 

2420  lbm-in2 

1770  lbm-in2 

Log  Moment  of  Inertia 

380  lbm-in2 

125  lbm-in2 

Ratio:  Body  Moment  of  Inertia  to 

6.4:1 

14:1 

Leg  Moment  of  Inertia 

L^-VcnkalMflliaQ 

Stroke 

10.0  in 

10.0  in 

Ideal  No-Load  Stroke  Time 

0.031  s  @90  psig 

0.040  s  @90  psig 

Static  Force 

140  lb  @90  psig 

80  lb  @90  psig 

Ratio:  Static  Force  to  Weight 

3.7:1 

4.2:1 

Theoretical  Max.  Work  per  Stroke  1400  lb-in  800  lb-in 

Sweep  Argle  57°/4l°  38° 

Ideal  No-Load  Sweep  Time  0.069  s  @3000  psig  0.010  s  @90  psig 

Static  Torque  800  lb-in/1200  lb-in  @2000  psig  240  lb-in  @90  psig 

Theoretical  Max.  Work  per  Stroke  740  lb-in  130  lb-in 


5.  Using  Tables  for  Dynamic  Stability  in  a  One- 
Legged  System 

5.1  Abstract 

A  legged  system  that  balances  as  it  runs  n\ust  choose  a  place  to  piit  each  foot  in  order  to  control  tipping  and 
forward  motion.  In  thin  paper  wc  dcsr  ibe  a  method  for  computing* a  suitable  location  ‘for  the  foot  that  .'?es  a 
large  table  of  pre-oomputed  data.  The  table  was  organized  around  a  subset  of  the  system  state  and  control 
variables,  and  the  stored  data  were  computed  by  numerically  simulating  a  dynumic  model  of  the  legged 
system  as  it  progressed  through  the  stance  portion  of  the  running  cycle.  Repeated  simulations  were  used  to 
characterize  the  non-linear  dynamics  of  the  system  for  different  landing  conditions.  The  approach  takes 
advantage  of  the  very  regular,  cyclic  character  of  legged  behavior.  Because  the  size  of  the  table  may  be 
prohibitively  large  for  some  problems,  polynomial  surfaces  were  used  to  approximate  the  tabular  data. 
Simulations  verified  the  feasibility  of  using  the  tabular  and  polynomial  methods  to  control  balance  and 
forward  travel  in  a  planar  one-legged  system. 

5.2  Introduction 

Control  algorithms  that  use  well  organized  tabular  data  offer  the  promise  of  providing  good  control  for 
systems  with  complicated  dynamics.  Tabular  techniques  are  powerful  because  they  use  the  results  of 
arbitrarily  complicated  calculations  for  control,  but  die  time  penalty  of  actually  doing  the  calculation  is 
incurred  off-line.  Therefore,  tabular  methods  typically  involve  very  simple  run-time  computations  that 
execute  with  high  speed.  In  a  comparison  of  techniques  for  computing  manipulator  dynamics,  Hollerbach 
showed  that  a  tabular  method  developed  by  Raibert  and  Horn  required  the  fewest  run-time  operations  when 
applied  to  a  manipulator  with  fewer  than  nine  joints  [150J. 

Another  advantage  of  tabular  control  methods  is  that  tables  make  it  easy  to  implement  simple  forms  of 
learning  and  adaptation.  A  tabular  controller  typically  performs  a  very  simple  computation  on  the  state 
variables  to  determine  appropriate  control  values.  The  computation  is  based  on  some  sort  of  representation 
of  the  dynamics  of  die  system  to  be  controlled.  Because  die  computations  arc  simple,  it  is  usually  easy  to 
determine  values  for  the  coefficients  of  die  computation,  provided  the  form  of  the  control  computation  is 
already  known.  Learning  occurs  when  coefficient  values  are  calculated  from  data  obtained  by  observing  the 
behavior  of  the  system  to  be  controlled  [3],  [4],  [2S2],  [230]. 

The  main  problem  with  tabular  control  mcdiods  is  that  the  size  of  die  tables  they  use  grows  exponentially 
widi  the  number  of  state  and  control  variables  needed  to  characterize  the  dynamic  system  [281].  This  problem 
has  been  attacked  in  a  number  of  ways.  Albus  used  a  hashing  function  that  mapped  tables  of  astronomical 
size  into  the  available  memory  of  his  computer  in  order  to  control  a  robot  manipulator  [3],  [4j.  His  hashing 


functions  were  designed  to  use  knowledge  of  the  manipulator’s  dynamics  in  order  to  minimize  hashing 
collisions.  Hashing  could  work  in  that  ease  because  the  controller,  rather  than  having  the  potential  of 
producing  all  possible  motions,  denit  only  with  the  subset  of  manipulator  motions  that  had  been  learned. 
Raibert  and  Horn  reduced  the  size  of  the  tables  needed  to  control  a  manipulator  by  striking  a  balance 
between  computation  and  tabularization  (283).  They  found  that  for  most  manipulators  with  n  joints,  an  n-l 
dimensional  coifiguration  space  table  would  do.  Simons  ol  ul.  reduced  the  size  of  the  tables  they  use  to  do 
manipulator  force  control  by  finding  an  optimum  quantization  of  the  state  inputs  (310). 

In  this  chapter  we  describe  a  tabular  controller  that  maintains  balance  and  regulates  forward  running  speed  in 
a  walking  system  that  hops  on  one  leg.  The  task  of  finding  a  useful  table  of  moderate  size  is  accomplished, 
not  by  manipulating  the  form  of  the  table,  but  by  partitioning  the  problem  into  parts  that  can  be  solved 
separately.  Once  die  problem  is  partitioned,  the  table  is  required  to  deal  with  only  a  subset  of  the  state 
variables.  We  use  the  stereotyped  cyclic  moMon  of  the  legged  system  to  find  a  simple  partitioning.  In  this 
chapter  we  also  show  that  multivariate  polynomials  of  low  degree  can  effectively  approximate  the  tabular 
data.  Evaluating  the  polynomial  requires  fewer  data  than  the  table,  but  somewhat  more  computation.  Both 
methods  are  used  to  control  the  one-legged  hopping  system  in  simulation. 

5.3  The  Problem 

During  hopping  in  place,  placement  of  the  foot  on  each  step  determines  how  a  legged  system  will  balance  and 
it  influences  die  system’s  translational  velocity.  Consider  the  planar  one-legged  system  shown  in  Fig.  5-1.  It 
has  a  rigid  body,  a  springy  leg,  a  hip  driven  by  torque  source,  r.  and  a  small  foot  The  system  is  described  in 
detail  in  [286].  If  die  foot  is  placed  to  the  left,  then  the  system  will  tip  and  accelerate  to  die  right.  If  die  foot  is 
placed  to  the  right,  dien  the  vice  versa.  If  the  foot  is  placed  directly  under  the  body,  then  the  system  will 
ncidier  tip  nor  accelerate.  A  corresponding  set  of  rules  applies  when  the  system  is  travelling  with  a  forward 
velocity.  For  each  forward  velocity  there  is  a  forward  position  for  the  foot  that  will  neidier  tip  the  system,  nor 
change  the  rate  of  forward  travel. 

The  effects  of  foot  placement  arc  important  because  the  foot's  position  can  be  directly  controlled  by  torquing 
the  hip  during  flight,  because  the  foot  cannot  be  moved  once  placed,  and  because  die  foot's  position  strongly 
affects  balance.  For  the  present  problem  we  think  of  die  loot’s  position  when  the  system  first  touches  the 
ground,  not  as  a  suite  variable,  but  as  a  control  variable. 

Once  a  cycle  of  stepping  activity  has  been  established,  the  problem  of  controlling  balance  and  forward 
velocity  is  one  of  choosing  a  place  to  put  die  foot  on  each  cycle  diat  will  take  the  system  to  the  desired  suite. 
More  specifically  the  control  task  is  to  find  a  position  for  the  foot  before  touch-down ,  die  moment  dicrc  is 
contact  between  the  foot  and  the  ground,  so  as  to  minimize  state  errors  at  lift-off,  the  moment  the  loot  nc;;t 
leaves  die  ground.  The  state  errors  of  interest  arc  those  in  forward  velocity.  x2,  body  angle,  and  body 
angular  rate,  Q 2> 


Figure  5-1:  Schematic  diagram  of  planar  one-legged  system  used  to  test  tabular 
control.  The  body  and  leg,  each  having  mass  aad  moment  of  inertia,  arc  connected  by 
a  hinge  joint  at  which  torques,  r,  arc  generated.  The  leg  consists  of  a  spring  in  series 
with  a  position  actuator  of  length  x  Center  of  mass  of  the  leg  is  located  a  distance  r. 
from  the  lower  tip  of  the  leg,  which  is  the  foot.  The  body  is  represented  by  a  rigid 
mass,  with  the  center  of  mass  located  a  distance  r 2  above  the  hip.  The  angle  of  the 
leg,  dy  determines  the  relative  position  of  the  fool  with  respect  to  the  system’s  center 
of  gravity.  Rhythmic  activation  of  the  leg  actuator,  x.  causes  the  system  to  leave  the 
ground  in  a  hopping  motion.  Morion  of  the  entire  system  is  restricted  to  the  plane. 

For  more  details  and  equations  of  motion  see  [286]. 

Assume  that  during  flight  the  leg  angle  will  be  adjusted  by  a  linear  servo  of  the  form: 

rtt)  =  Kt,(0r0LM)+  Kv(0:)  (5.1) 

where 

dy  d  is  the  desired  leg  angle,  and 
Kp,  Ky  arc  feedback  gains. 

Further  assume  that  during  stance  the  angle  between  body  and  leg,  (0y-  0,),  is  hold  constant  by  a  linear  servo 
similar  to  (5.1),  We  designate  the  value  of  a  variable  at  touch-down  by  die  subscript  I'D,  and  the  value  of  a 
variable  at  lift-off  by  subscript  I  o.  The  problem  to  be  solved  is.  given  the  state  at  touch-down,  X  find  0 , 
to  minimize; 


(5.2) 
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where: 

Qr  Qj,  Qj  arc  weights,  and 

<?2  d,  0^,  x^d  are  desired  values. 


5.4  Tabular  Method 


In  order  to  minimize  (5.2),  a  relationship,  T,  is  needed  that  relates  the  state  of  the  system  at  lift-off  to  the  state 
at  touch-down: 

=  nv  (5.3) 

In  general,  behavior  of  die  system  during  stance  is  influenced  by  the  entire  state  vector  at  touch-down.  • 

Xro  =  (x2’  x2-  yv  h'  9i '  9v  w<  (5.4) 


The  regular  nature  of  die  stepping  cycle  permits  us  to  partition  die  state  variables  >nto  two  groups,  these  that 
vary  from  one  stepping  cycle  to  the  next,  and  those  dint  do  not.  We  avsumc  dint  die  values  of  y2,  y2,  w.  and  w 
vary  along  the  same  trajectory-  from  one  cycle  to  the  next.  The  values  of  diesc  variables  arc  important  to  the 
relationship  expressed  in  (5.3),  but  their  effect  is  constant  from  nop  to  hop.  Therefore,  (5.3)  can  be  expressed 
as  a  function  of  a  subset  of  die  state  variables: 


(x2,lo’  9 ixo'  9  2,io 


)  = 


r(X2,TD’  9 2,to'  92;io'  9  i:u) 


(5.5) 


We  call  the  vector  xTO  =  [x2  rD,  02n,  ^  J  the  touch-down  state  vector.  =  [x2  to.  02td,  02m,  \  8ym] 
the  augmented  state  vector,  and  -  [x,  LQ,  $2  LO,  02  ]  die  lift-off  state  vector.  We  define  a  vector  field  A, 
such  that  there  is  a  dimension  of  A  that  corresponds  to  each  component  of  x’  ,  and  for  each  point  in  A  there 
is  a  unique  value  of  x  . 


For  this  problem  we  think  of  0 j  as  a  control  variable  since  it  can  he  changed  during  flight  at  will,  and  the 
remaining  components  of  x  as  suite.  In  general  dicre  arc  /  control  variables  and  n  state  variables. 


The  vector  field  A  is  approximated  by  a  multidimensional  table.  One  dimension  of  the  table  corresponds  to 
each  dimension  of  A.  and  ail  dimensions  arc  quantized  to  M  levels.  For  n  variables  and  i  control  variables, 
each  quantized  to  M  values,  dicre  arc  \T'f'  hyper-regions  in  die  table,  ouch  storing  an  /i-vcctor.  M  must  be 
chosen  to  quantize  die  table  finely  enough  level  to  capture  die  variations  in  x  . 

We  have  used  such  a  table  to  control  the  planar  hopper  in  simuladon.  Forward  velocity  x2,  body  angle  02, 
and  body  angular  rate  02,  are  the  state  variables  used  to  access  die  table,  //  =  3.  Teg  angle  is  a  control 


59 


variable,  /=  1,  lliese  variables  index  a  4  dimensional  space.  Each  dimension  of  the  memory  is  quantized  to 
nine  levels,  M  =9,  requiring  that  19,683  values  be  stored.  To  compensate  for  such  a  coarse 

quantization,  the  function  that  accesses  the  tabular  dau,  T(xl^),  performs  a  linear  interpolation  among  the 
l"*1  stored  values  that  bracket  the  desired  value. 

Tabular  data  were  obtained  by  simulating  a  large  set  of  locomotion  cycles,  with  systematically  varied  initial 
cbnditions.  For  these  simulations,  the  angle  between  leg  and  body  was  held  constant  by  (S.l)  during  stance, 
just  as  it  would  be  when  controlled.  In  order  to  minimize  (5.2)  the  table  was  searched  along  a  path 
determined  by  varying  ^  through  its  entire  range,  with  x=x11}.  The  details  of  the  search  arc  given  in 
Appendix  V.  The  leg  was  then  moved  just  before  touch-down  to  the  minimizing  value  of 

This  tabular  controller  was  tested  in  a  simple  simulated  balance  problem.  The  task  was  to  return  the 
one-legged  system  to  a  balanced  posture,  after  starting  with  the  body  in  an  Inclined  position.  Figure  5-2  plots 
die  body  angle  and  horizontal  position  of  the  hopper  for  the  test  in  which  the  hopper  was  dropped  from  a 
height  of  0.3  m  with  an  initial  body  angle  error  of  0.8  radians.  Setpoints  were  x2d  =0,  6^  *  0,  02d  -  0.  A 
vertical  posture  with  no  horizontal  motion  was  attained  in  about  6  see.  In  this  test  no  attempt  was  made  to 
control  x,.  horizontal  position. 

Ilic  same  algorithm  was  used  to  control  forward  velocity  while  die  system  traveled  from  one  point  to  another. 
Figure  5-3  shows  data  from  the '  resulting  translation  in  which  ;;2  was  controlled  indirectly  through  rate 
control.  Forward  velocity  was  very  slow,  but  precisely  controlled  widi  no  limit  cycles  like  those  caused  by 
linear  control.  The  low  rate  of  forward  travel  was  an  artifact  of  the  restricted  motion  of  die  hip  during  stance, 
.is  required  by  die  simple  foot  placement  algorithm.  It  is  not  an  inherent  attribute  of  the  tabular  control 
method. 

In  the  example  given  here,  the  control  variable,  8^,  was  not  explicidy  varied  during  die  interval  between 
touch-down  and  lift-off.  Hip  angle  was  fixed  during  stance.  In  general  it  is  not  necessary  that  the  control 
variables  be  constant,  only  that  they  do  not  vary  with  more  degrees  of  freedom  than  arc  represented  in  the 
table.  'Iliis  means  that  variations  in  die  control  signals  arc  perfectly  acceptable,  provided  that  dieir  variation  is 
completely  determined  by  the  augmented  state  vector  that  is  available  when  (5.3)  is  used. 


The  table  just  described  is  used  to  evaluate  (5.3).  Control  is  actually  served  by  evaluating: 


^I.td  ~  1  1(x2.lo’  ^2,1.0*  GUa  I  x2,td’  ^2,ra’  ^5-6) 

Eq.  (5.6)  was  effectively  implemented  by  searching  the  table.  It  is  possible  to  create  a  table  that  implements 


(5.6)  directly,  provided  specific  values  are  provided  for  x2,  ^2d>  d,  and  Qv  Q2,  Qr  Then  control  can 
proceed  without  search. 


Figure  5-2:  Orientation  of  the  body  is  corrected  using  tabular  method.  At  1=0  initial 
error  in  body  attitude  was  0.8  mdians.  At  t=l  gravity  is  turned  on  and  hopping 
begins.  State  errors  approached  zero  about  6  sec  later.  Horizontal  position  is  not 
controlled,  so  postiion  changes  without  correction.  (Q,  =1.5  .Q,  =  5.0  ,Q  =  1.0) 
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5.5  Polynomial  Approximation  to  Tabular  '^ata 

The  data  of  the  last  section  show  that  the  tabular  method  can  effectively  control  a  non-linear  dynamic  system 
with  few  state  and  control  variables.  However,  even  when  the  problun  is  partitioned,  the  memory 
requirements  for  this  approach  become  severe  in  larger  applications.  In  this  section  we  show  that  the  tabular 
data  can  be  approximated  by  polynomials  in  the  state  variables.  The  polynomials  can  have  many  fewer 
coefficients  titan  entries  in  die  oiiginal  table,  at  the  expense  of  additional  run-time  computation. 

Given  N~n+i  state  and  control  variables,  polynomials  were  constructed  that  map  touch-down  state  vectors 
into  estimates  of  lift-off  state  vectors.  Each  of  n  polynomials  minimizes  the  total  square  error  for  the  variable 
it  approximates  across  all  data  points  in  tine  table. 
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Figure  5*3:  Lateral  step  controlled  by  tabular  method.  (Q^-l.O,  Q,--5.0,  Q^-l.O) 


Let  A  be  a  matrix  in  which  each  row  contains  values  of  the  N  state  and  control  variables;  let  B  be  the  matrix 
that  contains  future  values  of  the  state  variables  in  corresponding  rows.  The  matrices  A  and  B  then  form  a 
data  structure  for  the  predictive  state  space  memory.  Given  a  sequence  of  distinct  terms  of  the  form: 

✓Yall  Ya12  va13/l4  vuMi  vaN12  YaM3  YrtM4v  /r 

*2  Xj  \4  . ^  *2  *3  *4  yo,') 

determine  u  row  of  the  M-column  matrix  C  by  evaluating  these  terms  at  the  values  defined  by  tire  same  row 
of  A.  Then 

(CTCX  =  CTB)  (5.8) 

is  a  linear  system  whose  solution  X  contains,  in  each  column,  the  coefficients  of  a  least  squares  polynomial 
that  estimates  the  values  in  tire  corresponding  column  of  B  [317],  The  polynomial  is,  of  course,  determined  by 
the  choice  of  the  exponents  in  tire  above  sequence,  including  many  set  to  zero. 

Using  the  polynomial,  (5.2)  can  be  minimized  in  closed  form.  The  details  of  tire  procedure  arc  given  in 
Appendix  Vi.  For  the  ease  of  tire  one-legged  machine,  x.,,  9 2,  and  8V  arc  ic  independent  variables  and 
0V  0V  and  x2  arc  the  variables  to  be  approximated. 
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Several  polynomials  have  been  generated  and  tested  using  the  same  procedure  described  earlier  for  Fig.  5-2, 
as  well  as  other  similar  tests.  In  each  case,  the  resulting  behavior  is  compared  to  that  obtained  with  the  tabular 
data: 

•  24  term  polynomial  consists  of  all  odd  terms  of  degree  3  or  less.  The  body  angle  did  not  reach  the 
setpoint  after  20  seconds. 

•  4Q  term  polynomial  consists  of  all  terms  of  degree  1  and  3,  with  16  terms  of  degree  5.  Behavior 
was  similar  to  the  table,*  with  slightly  less  rapid  convergence. 

•  ££  term  polynomial  consists  of  all  terms  of  degree  1,  3,  and  5.  Convergence  is  slightly  faster  than 
for  the  40  term  polynomial. 

•  £22  term  polynomial  consists  of  all  terms  such  that  the  exponents  of  each  of  the  independent 
variables  is  less  than  or  equal  to  4.  Behavior  is  very  similar  to  the  original  tabulated  data. 

The  approximation  error  for  each  polynomial  is  listed  in  the  following  table: 

Mean  Square  Error _ 


No.  of Terms  x2  02  0 


2 

2 

v2 

24 

0.602 

4.53 

40 

13.6 

0.527 

4.39 

68 

10.5 

0.359 

4.25 

625 

9.55 

0.308 

3.94 

To  use  the  table  we  must  search  it  at  run-time  to  find  the  entry  that  minimizes  (5.2).  Specifically  this  is  a 
search  where  02,  02andx2  are  fixed  and  9l  may  vary.  The  table  is  quantized  with  respect  to  at  nine 
equally  spaced  points  in  the  interval  -1  <  0^  <  1.  In  each  subintcrval  we  derive  a  linear  interpolation  formula 
for  each  element  of  \LQ.  Since  9^  is  the  only  free  variable,  we  substitute  the  interpolation  expressions  for  02, 
02  and  x2  into  MINIMIZE,  differentiate  with  respect  to  9y  set  the  result  equal  to  zero,  and  solve  for  9y 
Eight  candidates  arc  obtained.  We  select  the  one  that  minimizes  globally. 

A  similar  approach  is  used  in  applying  the  polynomial.  Since  02,  02  and  x2  arc  fixed  during  the  search  for  9y 
multivariate  polynomials  in  four  variables  are  made  simpler  polynomials  in  one  variable.  For  instance, 
consider  the  68  term  polynomials  discussed  above.  The  highest  power  of  9.  occurring  in  each  of  the  three 
polynomials  is  0,5.  When  computing  a  control  signal,  we  evaluate  six  coefficients  for  each  of  the  three 
polynomials:  these  arc  determined  by  the  given  values  of  0,,  02  and  x,  as  well  as  by  the  68  original 
coefficients.  The  six  term  polynomials  are  algebraically  substituted  into  (5.2).  and  the  resulting  polynomial  of 
degree  10  is  differentiated  with  respect  to  9y  The  result  is  a  single  polynomial  of  degree  9  in  9y  Its  zeros  are 
found  by  using  Laguerre’s  method  [DAH74J.  The  PI  is  explicitly  evaluated  for  each  real  zero  in  the  interval 
-1  <  01  <  1,  and  the  smallest  of  these  values  determines  the  globally  optimum  9y 
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Figure  5-4:  Polynomial  approximations  are  compared  to  tubular  data  in  test  that 
corrects  orientation  of  body,  using  same  procedure  as  in  Fig.  5-2.  fhc  responses  for 
the  tabular  data  and  four  different  polynomial  approximations  are  plotted.  See  text 
for  description  of  how  terms  were  chosen. 
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This  procedure  for  minimizing  (5.2)  docs  not  require  finding  die  zeros  of  a  large  polynomial  in  four  variables. 
For  example,  the  625  tcim  polynomials  with  all  possible  terms  of  degree  four  and  less  requires  zeros  of  a 
single  ninth  degree  polynomial  in  0 r 
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5.6  Appendix  V.  Algorithm  that  Minimizes  Performance  index  for  Tabular 
Data. 


Given  a  state  vector  at  touchdown  [02,02,x2]  it  is  required  to  find  the  value  of  0 1  that  minimizes  the 
performance  index  PI((02L,02l  ,x2L))  w*lcre  ^2L’^2L,X?.J  =  Tfl0l,02,02,x2])  is  the  state  vector  at  next  lift-off^ 
T  denotes  die  (unction  that  implements  the  interpolated  table  lookup.  Recall  that 


PI([02L.02|  ,x2iJ)  "  0\^2L  '  ^2,d^2  +  ^2^2L  *  ^2,d^  +  ^X2L  '  X2.d^ 
•  *  * 

where  Qp  Q2  and  Q3  arc  weights  and  02  d,  02  d  and  x2  d  are  desired  values. 


(5.9) 


Assume  that  0^  <02£  ^2a  ^  ^2 -  ^2B  an<*  *2A  ^  x2 £  X2B  where  the  A  and  B  subscripts  indicate  adjacent 

values  stored  at  quantized  locations  in  the  table.  Also,  assume  that:  Consider  as  an  example 

the  first  term  of  (5.9)  which  can  be  written  in  terms  of  the  tabulated  data: 


Qi<*2: 


2L 


0%p)2  - 


<# 


IB  "1A 


) 


“  *2./ 


(5.10) 


where  4, A  --  T[(01A,fl,,£2.x2))  and  0,B  “  T[(0|B,02,0.,,x2)].  In  other  words,  once  interpolation  has  been 
completed  for  the  three  state  variables,  two  adjacent  values  in  the  tabic  that  bracket  0y  0]A  and  0JB  arc 
substituted  in  die  lineal  interpolation  formula. 


Now  the  right  hand  side  of  (5.10)  can  be  rewritten: 

()i<VV’  =  <V«iQa  +  Qd>! 


(5.11) 


where  Qa  = 


^ml?2AlandQB  = 

(*1B-*ia) 


^IB'^IA  2’d' 


An  identical  treatment  of  the  other  two  terms  of 


(5.9)  yields 


PI  *  QitQA^i  f  V  +  Q2IQc*i  +  Qd]2  h  OjlQ^i  +  QFJ 2  (5.12) 

Upon  differentiation  with  respect  to  &v  setting  the  result  equal  to  zero,  and  solving  for  0{  we  have  a  closed 
expression  for  that  value  of  0.  that  minimizes  die  PI  in  die  interval  O,A<0,<  d,n: 


e  -  .  +  ^ AA) +  /5133 

a\-  -  r - - -  (5.U) 

q.qa-  +  Q2Oc2  +  q,oe2 

To  obtain  the  global  minimum  this  computation  is  performed  fir  each  of  the  M  subintervals  determined  by 
the  quantization  of  0V 
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5.7  Appendix  VI.  Algorithm  that  Minimizes  Performance  Index, for 
Polynomial. 


The  general  form  of  the  A'- term  polynomials  that  approximate  the  tabulated  data  Is: 

i,  _  f  /j“ii  f)an  ;“i3  :ai4  ,  ,  f  «aiu  Ski  0aK3  ;ffK4 

®  2L  -  fl/l  8  2  9t  X2  +  *  •  *  +  8l  8i  h 

a  _p  /jall  art12  AaJ3  'a14  /  ,  C  /,aKl /}aK2  «aK3  :.rtK4  ,c 

*21,  =  f2.1*l  8 2  8  2  X2  +  ' '  •  +  f2.K*l  8l  8 2  *2  ’  (5<l4) 

V  -  f  /}all  «a13  :a14  ,  ,  f  aaK\  iiaK2  «aK3  :aK4 

X2L  -  f3.1^1  8 1  8 2  X2  ^  v  fJ,K*l  *2  *2  X2 

where,  again,  the  L  subscript  denotes  values  at  next  lift-off  and  (02,02,x2J  is  a  state  vector  at  touch-down. 
Since  0.  is  the  only  free  variable,  (5,14)  can  be  recast  as: 


«2L=FU«/0  +  -'-  +  |:i.N»/N 

«2L  =  FJ.iO’  +  -'-  +  F2.NI»/’N 

i2L  =  |IM*l#<>  +  -  +  F3N*l,N 


(5.15) 


where  ft0  >  0  and  /Jv  is  the  highest  power  of  t?l  in  (5.14).  Substituting  these  equations  into  (5.9)  yields  a 
polynomial  of  degree  2/?  N  wh  ich  expresses  the  PI  as  a  function  of  0 ^ : 

PI  =  c0  +  0\d  +  s\a  +  ;\d  +  C,^0  +...  +  0*#*"  (5.16) 


The  real  rcros  of  the  derivative  of  this  polynomial  arc  found  using  Lagucrrc’s  method.  The  global  minimum 
is  found  by  evaluating  (5.15;  for  each  /cro  and  substituting  the  results  into  (5.9). 
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6.  Control  of  Balance  in  2D  -  Modeling  and 
Simulation  for  the  One-Legged  Case 

6.1  Abstract 

In  this  chapter  we  model  and  simulate  a  2D  one-legged  hopping  machine  in  order  to  better  understand  legged 
systems  that  hop  and  run.  The  analysis  focuses  on  balance,  dynamic  stability,  and  resonant  oscillation  for  the 
planar  case.  The  model  incorporates  a  springy  leg  with  non-zero  mass,  a  simple  body,  and  an  actuated 
hinge* type  hip.  We  decompose  control  of  the  model  into  u  vertical  hopping  part,  a  horizontal  velocity  part, 
and  a  body  attitude  part  Estimates  of  total  system  energy  arc  used  in  regulating  hopping  height  in  order  to 
initiate  hopping,  to  maintain  level  hopping,  to  change  from  one  hopping  height  to  another,  and  m  terminate 
hopping.  Balance  and  control  of  forward  velocity  are  explored  with  three  algorithms:  First  we  study  the  role 
of  foot  placement  in  balance  through  a  linear  algorithm  that  stabilizes  the  system  and  generates  low  velocity 
translations  from  point  to  point.  Second,  we  improve  control  of  forward  velocity  by  considering  constraints 
that  arise  in  constant  velocity  forward  travel,  and  we  introduce  die  CG' print.  The  improved  algorithm  places 
the  foot  forward  with  respect  to  the  ccntei  of  the  CG- print  during  flight,  and  sweeps  the  leg  backward  during 
stance.  Third  we  improve  control  of  body  attitude  by  using  die  hip  actuator  to  correct  pitch  errors  during 
stance.  Simulations  verjfj  die  feasibility  of  decomposing  control  of  running  into  a  height  comr  >1  part,  a 
forward  velocity  control  part,  and  an  attitude  control  part 

6.2  Introduction 

Substantial  study  has  been  devoted  to  understanding  legged  systems  that  crawl  and  walk,  but  little  attention 
has  been  given  to  systems  that  run  and  hop.  During  crawling  and  walking,  support  is  provided  by  at  least  one 
leg  at  all  times,  but  in  running  and  hopping  support  is  provided  only  intermittently,  with  intervening  periods 
of  ballistic  flight.  One  consequence  of  intermittent  support  is  the  vertical  bouncing  morion  that  characterizes 
running.  A  second  consequence  of  intermittent  support  is  die  intermittent  opportunity  for  die  system  to 
change  its  angular  momentum  to  maintain  balance  and  control  attitude.  Because  angular  momentum  is 
conserved  when  diere  are  no  external  forces  on  the  system,  torques  can  be  applied  to  the  body  to  change 
angular  momentum  only  when  the  system  is  in  contact  with  the  ground.  A  further  consequence  of 
intermittent  support  is  riiat  leg  dynamics  play  an  important  role  in  determining  a  system's  behavior  --  both  the 
pattern  and  efficiency  of  a  running  system’s  motion  are  influenced  by  leg  dynamics. 

In  this  chapter  wc  model  a  hopping  system  with  just  one  leg,  and  simulate  its  behavior  as  controlled  by 
algorithms  diat  manipulate  hopping  height  and  running  speed,  while  maintaining  balance  and  attitude.  The 
purpose  is  to  understand  the  principles  of  balance  and  dynamic  stability  as  they  apply  to  logged  systems,  while 
ignoring  die  problem  of  coupling  many  legs.  Since  each  leg  in  multi-legged  running  systems  docs  roughly  the 
same  thing  as  every  other  leg,  the  hopping  of  a  one-legged  model  can  be  viewed  as  a  fundamental  activity 
dirough  which  running  and  certain  types  of  walking  can  be  better  understood. 
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Hopping  is  actually  a  special  ease  of  running,  in  which  all  legs  provide  support  at  the  same  time.  For  a  system 
with  one  leg,  running  and  hopping  are  the  same.  The  part  of  the  stepping  cycle  in  which  the  leg  is  unloaded, 
called  transfer,  is  also  the  part  of  the  cycle  in  which  no  legs  give  support,  called  flight.  During  flight  motion  of 
the  center  of  gravity  of  the  system  is  ballistic.  The  period  when  the  leg  provides  support  is  called  stance, 
during  which  behavior  of  the  system  is  like  that  of  an  inverted  pendulum. 

The  model  developed  here  incoiporates  a  springy  leg,  in  imitation  of  legs  found  in  nature.  While  rigid 
massless  log  models  have  sufficed  to  study  walking  [338],  [128],  leg  models  that  include  mass  and  springs  are 
important  lor  understanding  running  and  hopping.  The  stiffness  of  the  leg  influences  thd  vertical  oscillatory 
behavior  of  the  hopping  system  and  governs  the  details  of  ianding  on  die  ground  and  of  taking  off.  The 
resonant  interaction  between  body  mass  and  springy  legs  in  the  vertical  direction  has  a  profound  impact  on 
the  behavior  of  a  running  system.  This  has  been  shown  by  McMahon  and  Green  [218]  in  the  human,  and  by 
Dawson  and  Taylor  164]  and' Alexander  and  Vcnion  [7]  in  the  hopping  kangaroo. 

Previous  work  on  balance  began  with  Cannon’s  control  of  inverted  pendulums  that  rode  on  a  small  powered 
truck  [141],  His  experiments  included  balance  of  a  single  pendulum,  two  pendulums  one  atop  the  other,  two 
pendulums  side  by  side,  and  a  long  limber  pendulum.  Hemami  and  his  co-workers  [99],  [  1 29].  [128],  [131], 
]50],  [135],  Vitkobratovic  and  lus  co-workers  [164],  [338],  [34?.].  and  others  [87],  [31 1,|  26],  (2*11 1,  [169]  have 
studied  the  dynamic  characteristics  of  a  variety  of  muln-link  legged  models  that  walk.  These  models  range 
from  a  fully  static  walking  biped  described  by  Juricic[l64]  to  the  dynamically  stabilized  live  link  model  of 
Hemami  and  Farnsworth  [128].  F  ich  of  these  models  relies  on  continuous  contact  with  the  support  surface. 
Additional  references  to  work  on  walking  can  be  found  in  the  biblmgi aphy. 

Balance  in  hopping  has  also  been  studied;  In  1967  Seifert  explored  the  concept  of  a  hopping  vehicle  for  lunar 
exploration  [302].  Many  interesting  ideas  came  from  his  aerospace  approach  to  that  problem.  Maisuoka  [196] 
analyzed  hopping  in  humans  with  a  one-legged  model.  He  derived  a  time-optimal  state  feedback  controller 
that  stabilized  his  system,  assuming  that  the  leg  could  oe  massless,  and  that  tire  stance  period  could  be  of  very 
short  duration.  In  fact,  legs  comprise  a  substantial  fraction  of  a  human’s  mass,  and  the  duration  of  stance 
during  miming  for  each  leg  of  a  biped  is  about  4,V7p  of  the  total  duration  of  a  stride  [196].  Therefore  the 
model  used  here  includes  non-zero  leg  mass,  and  a  ratio  of  leg  stiffness  to  body  mass  that  makes  it  operate  in  a 
regime  where  support  time  is  about  40%  of  stride  time. 

In  this  paper  control  of  hopping  is  presented  as  two  parts,  a  vertical  control  part  that  ure«  energy  measures  to 
regulate  hopping  height,  and  a  horizontal  control  part  that  maintains  balance  and  generates  forward  travel. 
Although  there  arc  interactions  between  these  activities,  their  dynamics  arc  not  strongly  coupled.  The  section 
that  follows  develops  die  one-legged  hopping  model  and  characterizes  its  behavior.  Section  III  presents  an 
analysis  of  hopping  and  die  control  algorithm  used  to  regulate  hopping  height.  Section  IV  describes  three 
algorithms  that  provide  balance  while  hopping  in  place  and  miming. 
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6.3  The  Model 

The  basic  components  of  legged  systems  are  a  set  of  legs  and  a  body  to  which  the  legs  are  attached.  For 
humans  and  other  animals  the  body  has  many  actuated  degrees  of  freedom  whose  actions  enhance 
performance  and  versatility.  For  instance,  stretching  of  Lite  back  efficiently  increases  stride  length  for  the 
running  quadrupeds.  The  body  also  carries  the  payload  and  sensors.  The  most  important  characteristic  of  the 
body  is  that  it  forms  an  elevated  mass  that  must  be  balanced  atop  the  legs,  and  that  it  forms  a  structure  from 
which  torques  can  be  applied  to  the  legs. 

Legs  typically  do  two  things  during  locomotion:  they  change  length  and  they  change  orientation  with  respect 
to  the  body.  This  is  true  for  organisms  that  crawl,  walk,  run,  and  hop,  and  for  organisms  with  two  legs,  four 
legs,  six  legs,  and  many  legs.  A  log  changes  length  to  propel  the  body  upward  and  forward,  to  cushion 
landings,  and  to  reduce  its  own  moment  of  inertia  and  increase  its  clearance  when  swung  forward.  The 
lengthening  and  shortening  of  a  leg  during  these  activities  is  not  merely  a  kinematic  action,  but  a  dynamic 
action  governed  by  tire  resonant  interaction  of  leg  compliance,  body  mass,  and  gravity  [46].  Energy  is  stored 
in  springy  muscle  and  tendon  when  the  leg  is  shortened,  and  energy  is  retrieved  when  the  leg  is  lengthened. 
Legs  swing  back  and  forth  to  propel,  to  permit  feet  to  be  precisely  positioned  will)  respect  to  the  system’s 
center  of  gravity,  and  to  change  angular  momentum. 

The  model  used  in  this  paper,  shown  in  Fig.  6-1,  has  a  single  springy  leg  that  articulates  with  respect  to  a  body 
about  a  simple  hinge-type  hip.  The  body  is  represented  by  a  rigid  mass,  to  which  die  leg  is  connected.  The 
leg  has  mass  Mr  moment  of  inertia  lr  and  the  body  has  mass  M,.  moment  of  inertia  I2>  The  center  of  mass  of 
the  leg  is  located  a  distance  i  j  from  die  lower  tip  of  die  leg,  which  is  the  foot.  The  center  of  mass  of  die  body 
is  located  a  distance  r2  above  die  hip. 


A  control  torque,  r,  is  generated  between  the  body  and  the  leg  at  the  hip.  A  simple  linear  servo  is  closed 
around  this  actuator  to  position  the  leg  or  body.  It  is  of  the  form: 

r(t)  =  Kp(tf1-t?1(1)  +  Kv«?1)  (6.1) 

where 

0ld  is  the  desired  leg  angle,  and 
Kp,  Kp  are  feedback  gains. 

The  same  feedback  rule  is  used  during  stance  and  during  flight,  but  with  different  values  for  Kp  and  Kv,  as 
listed  in  Appendix  VIII. 

The  leg  is  composed  of  a  spring  in  scries  witli  a  position  actuator.  The  spring  is  soft  in  compression  and  sdff 
in  extension.  The  soft  region  of  die  leg  spring  represents  'he  ability  of  the  leg  to  absorb  energy  when  it 
shortens.  The  purpose  of  die  stiff  region  of  the  spring  is  to  model  the  effect  of  a  mechanical  stop  that  limits 
extension  of  the  leg  to  a  maximum  length.  Modeling  die  mechanical  stop  as  a  spring  alone  would  lead  to 
vibration  whenever  the  spring  was  fully  extended,  so  damping  was  added  to  its  stiff  region.  The  damping 


Figure  6-  f :  Planar  one-legged  model  used  Tor  analysis  and  simulation.  The  body  and 
leg,  each  having  mass  and  moment  of  inertia,  arc  connected  by  a  hinge  joint  at  which 
torques  arc  generated.  The  leg  consists  of  a  spring  in  scries  with  a  position  actuator. 

The  support  surface  is  springy  itself  in  two  dimensions.  The  model  is  restricted  to 
motion  in  the  plane.  Sec  Appendix  VII  for  equations  of  motion  and  Appendix  VIII 
for  model  parameters  used  in  simulations. 

coefficient,  Bu,  is  chosen  so  that  vibrations  that  occur  between  body  and  leg  when  the  stop  is  hit  decay  within 
a  few  cycles.  The  length  of  the  position  actuator,  x.  determines  the  rest  length  of  the  leg.  While  the  position 
actuator  is  represented  as  an  ideal  source,  the  finite  response  time  of  a  physical  actuator  is  taken  into 
consideration  by  requiring  that  x  increase  and  decrease  with  a  quadratic  trajectory: 

X  =  Xo  +  *t2  (6.2) 

where 

X0  is  die  initial  length  of  position  actuator,  and 
k  is  a  timing  constant 

Stroke  of  the  position  actuator  is  limited  to  xmjn  <  x  <  xmax-  I  he  importance  of  this  arrangement  of  actuator, 
spring,  and  mechanical  stop  is  that  during  support,  rhythmic  activation  of  die  actuator  can  excite  resonant 
oscillations  in  die  spring-mass  system  formed  by  body  and  leg.  As  those  oscillations  build  in  amplitude,  the 
system  will  leave  the  ground  and  hop. 
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The  support  surface  is  modeled  as  u  two  dimensional  spring,  KQ,  and  damper,  Bu>  One  dimension  of  the 
spring  acts  vertically,  the  other  horizontally,  will)  no  interaction  between  the  two.  The  spring  and  damper 
influence  die  hopper  only  when  the  foot  is  in  contact  with  die  ground,  yQ  <  0.  During  flight  the  coefficients 
of  spring  and  damper  are  zero.  Each  time  die  foot  touches  the  ground,  the  rest  position  of  the  horizontal 
ground  spring  is  reset  to  the  point  at  which  the  foot  first  touches.  The  damping  coefficient  is  chosen  to  make 
vibrations  between  the  foot  and  ground  negligible,  while  die  coefficient  of  Diction  between  the  foot  and 
.  ground  is  assumed  to  be  so  large  diat  slipping  never  occurs. 

The  leg  actuator  acts  between  the  body  and  leg  spring.  Lengthening  die  actuator  when  die  leg  is, providing 
support  and  die  spring  is  in  its  soft  region  does  positive  work  on  the  system  by  compressing  the  spring  and 
accelerating  die  body  muss  upward.  Shortening  die  actuator  during  support  does  negative  work  on  the 
system.  Changing  the  length  of  the  position  actuator  during  flight  results  in  no  net  change  in  system  energy, 
since  this  produces  oscillations  of  the  leg  spring  that  arc  rapidly  damped  by  the  mechanical  stop.  Energy  is 
injected  into  die  system  over  a  number  of  hopping  cycles  Ly  lengthening  die  position  actuator  during  support 
and  shortening  it  during  flight.  By  changing  the  phase  of  these  actions  it  is  possible  to  remove  energy  from 
the  system. 

The  leg  mass.  Vf  represents  diat  portion  of  the  leg  below  the  spring,  die  rest  being  included  in  M2.  We  also 
assumed  that  the  stiffness  of  the  ground  is  much  greater  than  the  stiffness  of  the  leg.  KQ  >>  K, .  When  the 
leg  provides  support  die  model  is  a  spring-mass  oscillator  with  natural  ficqueney: 


wn  = 


M, 


Each  stance  interval  has  durauon: 


ST 


W 


K. 


During  flight  the  model  is  a  gravity-mass  oscillator.  A  full  hopping  cycle  has  period: 


T 


g 


where 

K(  is  the  stiffness  of  leg  spring, 

Hq  is  the  hopping  height  measured  at  die  foot  and 
g  is  die  acceleration  of  gravity. 

For  the  duration  of  support  to  equal  the  duration  of  (light,  hopping  height  must  be: 


(6.3) 


(6.4) 


(6.5) 
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(6.5) 


A  parameter  that  is  important  to  the  mechanical  design  or  a  legged  system  is  how  much  the  spring  must 
compress  and  the  leg  shorten  during  die  stance  portion  of  die  hopping  cycle.  The  maximum  compression  of 
the  leg  spring  during  stance  is  a  (Unction  of  body  mass,  leg  stiffness,  and  hopping  height. 


Equations  of  motion  for  the  model  with  respect  to  a  ground-centered  coordinate  system  were  derived  using 
d’Alembert’s  principle.  The  rcsuldng  system  of  non-linear  coupled  differential  equations  arc  given  in 
Appendix  VII.  These  equations  describe  die  system’s  behavior  for  both  stance  and  fiight,  with  the 
characteristic  equation  of  the  ground  spring  responsible  for  introducing  the  multi-phase  nature  of  die  model. 
Computer  Simulations  used  standard  digital  numerical  integration  techniques  to  determine  system  behavior  as 
a  function  of  time.  The  numerical  constants  used  for  simulation  arc  given  in  Appendix  VIII. 


The  simple  nature  of  this  model  captures  the  important  aspects  of  dynamic  locomotion  while  keeping 
complications  to  a  minimum:  Since  Uierc  is  only  one  leg,  active  balance  is  studied  directly  while  avoiding  the 
problems  of  coupling  between  legs  and  of  multiple  support  phases.  At  the  same  Lime,  vcitical  oscillations  are 
easily  studied  by  using  a  leg  model  that  includes  mass,  spring,  and  position  actuator.  Three  dimensional 
dynamics  arc  avoided  by  considering  the  planar  case. 


6.4  Vertical  Control 

The  task  of  synthesizing  a  system  that  will  control  behavior  of  die  one-legged  model  was  broken  intc  two  sets 
of  algorithms.  One  set  of  algorithms  controls  forward  running  velocity,  allowing  die  system  to  translate  from 
place  to  place  while  maintaining  the  body  in  an  upright  posture.  This  is  called  horizontal  control,  about 
which  more  is  said  in  the  next  section.  This  section  discusses  a  separate  control  algorithm  that  controls 
vertical  motion,  it  generates  stable  resonant  oscillations  that  cause  die  locomotion  system  io  hop  off  the 
ground,  and  it  controls  die  height  of  each  hop. 

An  important  function  of  this  hopping  motion  is  to  establish  a  regular  cycle  of  activity  within  which 
horizontal  and  altitude  control  cart  take  place.  A  wheel  changes  its  point  of  support  continuously  and 
gradually  while  bearing  weight.  Unlike  a  wheel,  a  leg  changes  its  point  of  support  all  at  once  and  must  be 
unloaded  to  do  so.  Therefore,  in  order  for  a  legged  system  to  balance  and  to  make  forward  progress  there 
must  be  periods  of  support  when  the  leg  bears  weight  making  the  foot  immobile,  and  dicrc  must  be  other 
periods  when  the  leg  is  unloaded  and  the  foot  free  to  move.  Such  ail  alternation  between  a  loaded  phase  and 
an  unloaded  phase  is  observed  in  the  legs  of  all  legged  systems.  For  the  present  system  Lhis  alternation  is  die 
hopping  cycle. 
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There  ere  Pour  well  defined  events  in  the  hopping  cycle: 

•  LIFTOFF:  The  moment  at  which  the  foot  loses  contact  with  the  ground. 

•  top:  The  moment  in  flight  when  the  body  has  peak  altitude  and  vertical  motion  changes  front 
upward  to  downward. 

•  touch-down:  The  moment  the  foot  makes  contact  with  the  ground. 

•  norro.M:  The  moment  in  stance  when  the  body  has  minimum  altitude  and  vertical  motion  of 
body  changes  fYom  downward  to  upward. 

These  events  are  cad.  detected  fiom  behavior  of  'he  state  variables,  and  arc  used  to  determine  four  distinct 
states.  The  regular  cyclic  progression  among  these  states  suggests  use  of  a  finite  state  sequencer  to  organize 
control  of  the  system. 

Vertical  control  muct  initiate  hopping,  control  hopping  height,  change  between  different  hopping  heighrs, 
and  terminate  hopping.  These  tasks  can  be  accomplished  by  regulating  the  energy  in  the  oscillating  spring- 
mass  .system  formed  by  the  springy  leg  and  the  mass  of  the  body.  Hopping  is  initiated  by  exciting  die 
spring/mass  oscillator  with  the  pusition  actuator  until  hopping  velocity  is  reached  -  when  the  inertial  forces 
arc  sufficiently  large  to  overcome  gravity,  the  foot  leaves  the  ground  and  bopping  begins.  At  this  point  the 
system  becomes  a  spring/mass,  gra  vity/tnass  oscillator. 

'Hie  height  of  a  hop  can  be  controlled  by  measuring  and  manipulating  the  system’s  energy.  For  Uie  simplified 
case  in  which  motion  is  primarily  vertical,  angles  and  angular  rates  of  the  leg  and  body,  0^,  02,  and  02  arc 
negligible.  The  total  vertical  energy  during  stance: 

Esmnch  =  +  ™g(M2>+  KE(Mp  +  KE(M2)  +  PEe(Mj)  +  PEp(M2)  (6.8) 

=  M1gy1  +  M2gy2  4-  .5  iV^yJ  +  .5  M2y^  +  .5  KL(kQ-w  +  x)2  +  .5  KQyJ 


where 

PHg  is  gravitational  potential  energy, 

PE  is  clastic  potential  energy, 

KE  is  kinetic  energy, 
g  is  die  acceleration  of  gravity,  and 
kQ  is  the  rest  length  of  the  leg  spring. 

Additional  variables  arc  defined  in  Fig.  6-1.  The  expressions  for  potential  energy  were  chosen  so  that  they  are 
zero  when  die  hopper  is  standing  vertically  with  the  leg  spring  extended  to  its  rest  length  and  with  the  foot 
just  touching  die  ground.  As  (6.8)  shows,  energy  may  be  stored  in  the  leg  spring,  in  die  ground  spring,  and  in 
the  motion  of  die  body  and  leg  masses. 
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Energy  is  lost  to  die  ground  damping  throughout  stance  and  to  air  resistance  throughout  the  hopping  cycle, 
but  such  losses  arc  generally  small  [280]  nnd  arc  disregarded.  Significant  energy  losses  occur  at  two  events  in 
the  hopping  cycle,  touch-down  and  lift-off.  At  touch-down  the  leg  is  very  suddenly  brought  to  rest  by 
dissipating  its  kinetic  energy  in  ground  damping: 

=  KE<Mt>  =  <«•!» 

where 

y\ TO.  is  the  vertical  velocity  just  before  touch-down. 

At  l.irr-OFF  damping  in  the  stiff  region  of  the  leg  spring  dissipates  a  fraction  of  the  system's  kinetic  energy. 
This  fraction  can  be  calculated  by  equating  the  system’s  linear  momentum  just  before  and  after  lift-off. 
Since  the  leg  is  stationary  during  stance  it’s  vertical  velocity  is  zero.  When  the  leg  extends  fully  during  stance 
the  hopper  leaves  the  ground,  accelerating  the  leg  from  rest  to  y;  LQ+.  After  lift-off  the  leg  and  body  move 
at  die  same  rate.  Equating  linear  momentum  before  and  after  lift-off: 

=  <Ml+M2>y2,u>.  (610) 


^2,1.0+ 

M,  - 

(M1  +  M2)yU°‘ 

(6.11) 

Substituting  (6.11)  back  into  (6.8),  the  kinetic  energies  before  and  after  1JFT-0FF,  and  the  loss  associated  with 

accelerating  the  leg  upward  are: 

KEu>- 

"  -  j  M2y2,Lo- 

(6.12) 

KE.o* 

-  y2 

2(M1  +  M2)  2,L°" 

(6.13) 

Eloloss 

M,  M.M,  •, 

-  - l~KKl0.(M;)  =  — 1— 2— yl,0. 

+  2(Ml  +  M2) 

(6.14) 

where 

KK  (M2)  is  the  total  kinetic  energy  just  before  LIFT-OFF, 

y2u)_  is  die  vertical  velocity  of  the  body  just  before  l.irr-OFF  and 

Subscript  L0-  means  just  before  LIFT-OFF. 


The  fraction  M-j/fN^  +  M.,)  represents  a  fundamental  efficiency  of  the  leg.  It  is  maximized  when  the  ratio  of 
leg  mass  to  body  mass  is  minimized.  This  can  be  done  by  minimizing  the  unsprung  mass  of  the  leg. 


75 


To  compensate  for  losses  the  vertical  controller  operates  the  position  actuator  to  increase  the  vertical  energy. 
When  x  changes  from  X(  to  X(+ AX  with  w  <  Kq  ^cn  t^cre  *s  an  ener8y  change: 

AEx  =  Kl[.5AX2  +  Ax(k0-w+X/)]  (6.15) 


Energy  is  removed  when  AX  is  negative.  For  a  given  Ax  the  magnitude  of  AE  depends  on  the  length  of  the 
leg  and  the  position  actuator.  More  work  is  done  when  the  spring  is  compressed  than  when  it  is  relaxed. 
Lengthening  the  actuator  at  BOTTOM  and  shortening  during  flight  causes  the  total  hopping  enctgy  to  increase. 
Shortening  the  actuator  at  UOTTOM  and  lengthening  during  flight  causes  the  total  hopping  energy  to  decrease, 
eventually  to  zero. 


The  task  of  the  vertical  control  algorithm  is  to  manipulate  the  altitude  to  which  the  system  will  bounce.  If  the 
leg  spring  assumes  its  rest  length  during  flight,  all  energy  takes  the  form  of  gravitational  potential  when  y,-0 
at  the  top  of  each  hop.  It  is  possible,  therefore,  to  predict  the  height  of  the  next  hop  at  any  time  during  stance. 
All  energy  is  in  the  form  of  kinetic  energy  at  lift-off: 


lo- 


-  KE, 


1.0- 


=  F, 


STANCH 


(6.16) 


The  fractional  loss  of  kinetic  energy  at  LIFT-OFF  is  known  from  (6.14).  Neglecting  ground  damping  and  air 
resistance  losses,  the  total  energy  during  flight  is  obtained  in  tenns  of  variables  available  during  stance  by 
combining  (6.14)  and  (6.8): 


E  -  kf 

FUCHIT  lO* 


(6.17) 


M, 


M  +M, 

i  2 


—  KE 


LO 


=  — [  MxgyL  -f-  M2gy2  +  .5  M^2  +  .5  M2y2  +  .5  KL(kQ-w+x)2  +  .5  KQy2] 

Mj  +  Mj 

For  die  body  to  hop  to  height  H  the  total  vertical  energy  must  be: 

E„  =  M1g[H-r2-(k0-r1))]  4-  M2gII 

During  stance  die  energy  change  needed  to  produce  a  hop  of  height  H: 


(6.18) 

(6.19) 


M 


2 —  E„ 


Mt+M2 


STANCE 


This  energy  can  be  supplied  or  removed  by  the  vertical  actuator, 
must  extend  by: 


From  (6.15)  and  (6.19)  die  linear  actuator 
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Ax  =  -(x  -  w  +  lg  + 


(X  -  +  w>  + 


K. 


(6.20) 


Simulations  were  used  to  evaluate  application  of  this  vertical  control  algorithm  to  the  model.  Each  time 
bottom  occurred,  indicated  by  yQ  changing  sign  from  negative  to  positive,  (6.8)  and  (6.17)  were  used  to 
predict  hopping  height.  'Hie  length  of  the  leg  actuator,  x.  was  then  increased  or  decreased  accordingly. 
Figure  6-2  plots  die  vertical  position  of  the  foot  and  body,  and  the  actuator  length  during  a  period  of 
increasing  hopping  height,  and  during  stable  .hopping.  Starting  at  rest,  the  system  executed  a  positive  work 
cycle  on  each  hop  until  the  vertical  energy  increased  to  the  specified  value.  This  level  was  then  maintained. 
Since  the  stroke  of  the  position  actuator  was  limited  to  xmax.  energy  that  could  be  injected  on  a  single 
cycle  was  limited.  A  number  of  cycles  therefore  were  required  to  achieve  the  desired  hopping  height. 
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Figure  6-2:  Vertical  hopping.  Starting  from  rest,  vertical  energy  was  increased  until 
desired  hopping  height  was  attained.  Hopping  height  was  regulated  rough  the 
position  actuator  that  acts  in  series  with  the  leg  spring.  Note  riiPe.e  t  vertical  scales, 
l  op  curve:  elevation  of  hip,  Middle  curve:  elevation  of  foot 


I’hc  last  2  seconds  of  data  Tom  Fig.  6-2  arc  rcplotted  in  tin-  phase  plane  in  Fig.  6-3.  'Hie  body  velocity  is 
plotted  on  the  abscissa  and  body  altitude  is  plotted  on  the  ordinate.  The  parabolic  trajectory  during  flight  was 
caused  by  constant  gravitational  acceleration,  and  the  harmonic  trajectory  during  stance  was  due  to  the  spring. 
The  four  events  that  synchronized  actions  of  die  controller  to  behavior  of  the  hopping  system,  l.irr-OFF,  TOP, 
TOUCH-DOWN,  and  bottom  arc  indicated  in  the  figure. 
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Figure  6*3:  Phase  plot  for  vertical  hopping.  Four  synchronization  events  are 
indicated  where  curve  crosses  axes.  Data  arc  from  stable  part  of  Figure  6-2.  The 
rough  part  of  die  curves  between  uft  orn  and  top  indicate  die  damped  vibration  that 
occurred  when  the  mechanical  stop  was  hit.  Note  that  position  is  plotted  on  the 
ordinate,  velocity  is  on  the  abscissa,  and  the  action  advances  in  a  counterclockwise 
direction. 

Figure  6-4  is  a  plot  of  vertical  energy  during  two  cycles  of  fixed  height  hopping.  A  lossless  system  would 
produce  a  perfectly  fiat  total  energy  line.  The  primary  losses  occur  when  the  foot  strikes  the  ground,  and 
when  it  leaves  the  ground,  as  indicated  by  (6.9)  and  (6.14).  Energy  increases  during  the  latter  part  of  stance, 
when  the  actuator  lengthens.  These  data  arc  similar  in  qualitative  detail,  to  those  obtained  for  the  kangaroo 
by  Alexander  and  Vernon  (7). 

Figure  6-5  shows  an  80  second  simulation  sequence  of  vertical  hopping  in  which  desired  height  was  adjusted  a 
number  of  times.  It  was  mentioned  earlier  that  the  leg  actuator  could  bo  used  to  remove  energy  from  die 
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Figure  0-4:  Vertical  energy  for  two  hopping  eyelet-  ai  constant  hopping  height.  Total 
entrgy.  kinetic  energy,  gravitational  potential,  and  elastic  potential  are  shown. 

Primary  losses  of  energy  occur  at  touch  down  and  tu-T  off,  indicated  by  the  vertical 
doued  lines.  Data  are  from  Fig.  6-2,  t  =  7,5  to  9.3  sec. 

system,  to  reduce  hopping  height.  The  figure  shows  that  a  descent  employing  active  damping  (t=45)  was 
more  rapid  than  one  relying  on  passive  system  losses  (t = 65).  in  general,  the  algorithm  obtained  good  control 
of  hopping  height. 

The  time  at  which  the  leg  is  shortened  daring  a  steady  state  hop  cycle  can  be  manipulated  to  optimize 
hopping  according  to  a  variety  of  criteria: 

•  When  the  leg  is  shortened  at  L.iFr-oi  F,  ground  clearance  of  the  foot  during  (light  is  optimized. 

This  is  important  when  terrain  is  uneven  or  when  large  horizontal  swinging  motions  of  the  leg 
occur  during  flight,  as  when  the  model  translates  at  high  speed.  If  the  leg  is  not  short  during 
swing  it  may  become  difficult  to  avoid  stubbing  the  toe.  Shortening  at  L.IFf-Ol  F  also  minimizes  the 
leg  s  moment  of  inertia  during  flight,  so  the  leg  can  be  swung  forward  faster  and  with  less  angular 
effect  on  the  body, 

•  When  die  leg  is  shortened  at  TOP.  the  time  between  vertical  actuations  is  maximized.  This  strategy 
could  permit  use  of  an  actuator  of  lower  bandwidth. 
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Figure  6-5:  Ventral  hopping  sequence.  At  tines  t  -  9.  15,  25,  35,  45,  55,  65  desired 
hopping  height  H  -  1.7,  2.0,  1.6,  1.9,  1.4,  1.9,  1.4.  The  descent  beginning  at  t— 45 
was  actively  damned.  while  the  descent  at  t  —  65  was  passive.  Top  curve:  elevation  of 
hip  Middle  curve:  elevation  of  foot 

•  When  the  leg  is  .shortened  occurs  upon  iouch-down,  then  the  ground  impact  forces  on  the  foot 
arc  minimized.  This  strategy  is  normally  used  by  humans  when  they  are  asked  to  hop  in  place  on 
a  flat  floor. 

It  is  also  possible  to  shorten  the  leg  at  LIFT-OFF,  lengthen  it  again  just  before  die  next  TOUCH-DOWN,  and  let  it 
shorten  during  the  landing.  This  strategy,  apparently  used  by  humans  when  running,  maximizes  ground 
clearance  and  simultaneously  minimizes  impact  forces  on  the  foot.  However  this  is  accomplished  at  die 
expense  of  additional  actuator  bandwidth.  Although  more  energy  is  required  for  these  extra  lengdiening  and 
shortening  motions,  die  leg  can  be  swung  forward  more  efficiently  with  a  lower  moment  of  inertia. 

6.5  !V.  Horizontal  Control 

The  preceding  seclion  discusses  die  vertical  hopping  behavior  of  the  model,  and  a  method  for  controlling 
hopping  height.  We  now  turn  to  die  question  of  balance,  and  control  of  travel  from  place  to  place.  These  two 
phenomena  arc  intimately  related.  The  tasks  of  a  balance  algorithm  are  io  ensure  diat  die  re  arc  no  unwanted 
horizontal  motions,  that  horizontal  motions  of  adequate  velocity  arc  generated  when  necessary,  and  that  the 
locomotion  system  docs  not  tip  over. 
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An  important  characteristic  of  dynamically  stabilized  legged  systems  is  that  they  arc  always  tipping,  but  their 
control  system  ensures  that  the  tipping  motions  are  controlled  and  orderly.  Two  mechanisms  can  be  used  to 
control  balance  and  horizontal  travel:  foot  placement  and  hip  motion.  Placement  of  the  foot  with  respect  to 
the  center  of  gravity  of  a  locomotion  system  has  a  powerful  influence  on  the  tipping  and  horizontal  motion  of 
the  system.  Gravity  generates  a  moment  about  die  foot  proportional  to  the  horizontal  displacement  of  the 
foot  from  the  center  of  gravity.  Foot  placement  can  be  adjusted  during  the  flight  part  of  each  hop  to 
influence  attitude  and  translation  during  the  next  stance  interval.  The  pattern  of  hip  motion  between  the 
body  and  leg  during  stance  influences  the  angular  momentum.  Such  motions  change  the  momentum  of  the 
system  only  during  stance  when  there  is  adequate  friction  to  hold  the  foot  firmly  in  place  on  the  ground. 

Actually,  there  is  a  third  mechanism  that  can  influence  die  balance  and  horizontal  travel  of  a  legged  system. 
Since  a  leg  is  not  always  vertical,  it  is  possible  to  influence  the  system’s  horizontal  behavior  by  modulating  the 
forces  generated  along  the  leg’s  axis.  Effective  use  of  this  mechanism,  however,  requires  intimate 
coordination  between  vertical  and  horizontal  control.  In  order  to  keep  the  vertical  control  mechanisms 
separate  from  the  horizontal  control  mechanisms,  and  thereby  obtain  simplicity  in  die  control,  this 
mechanism  is  not  used.  Rather,  wc  assume  that  die  pattern  of  axial  leg  forces  is  dictated  solely  by  die 
requirements  of  regulating  resonant  vertical  hopping. 

The  remainder  of  this  section  explores  three  algorithms  for  controlling  balance  and  travel.  The  first  method 
relics  solely  on  foot  placement  as  a  means  for  effecting  horizontal  control,  with  no  hip  motion  during  stance. 
The  second  method  uses  an  improved  foot  placement  algorithm  that  is  developed  by  considering  the 
kinematic  constraints  imposed  bv  constant  velocity  locomotion.  The  improved  root  placement  is  combined 
with  hip  motion  diat  sweeps  the  leg  backwards  during  stance.  The  third  method  uses  the  same  foot  placement 
as  mcdrod  two,  but  gets  better  control  of  body  attitude  by  servoing  die  body  angle  during  stance. 

6.5.1  Method  1:  Foot  Placement 

Each  time  a  hopping  system  touches  die  ground  die  foot  can  be  positioned  horizontally  to  influence  the 
translation  and  tipping  of  the  system.  When  hopping  upright  in  place,  (0.  =  0,  0,  =  0.  x2  =  0),  movement 
of  die  foot  to  one  side  during  flight  causes  the  body  to  tin  and  translate  toward  the  oilier  side  during  stance. 
Similar  rules  hold  when  die  system  is  not  upright  and  stationary.  Therefore,  if  the  hip  angle  is  kept  fixed 
during  stance,  ic.  (0^-0])io  =  (0,-^)^,  then  me  model  behaves  qualitatively  like  a  one  link  inverted 
pendulum.  It  is  no'  precisely  an  inverted  pendulum  because  die  leg  shortens  during  stance. 

A  simple  algorithm  to  balance  die  model  uses  linear  feedback  to  place  die  foot.  Two  factors  determine  where 
die  foot  should  be  placed:  die  projection  of  center  of  gravity  and  an  error  function  of  state  variables.  First, 
the  projection  of  the  center  or'grav'tv.  x  is  calculated.  Then  a  linear  function  of  errors  in  state,  x  ,  is 

<  (j  KRR 

added.  Model  kinematics  arc  dicn  used  to  calculate  a  leg  angle  diat  places  the  foot.  Since  die  leg  has  mass, 
movement  of  the  leg  changes  the  projection  of  the  center  of  gravity  --  simultaneous  equations  are  solved.  'Hie 
following  analysis  is  done  in  a  coordinate  system  that  translates  with  the  hip. 


Find  horizontal  position  of  center  of  gravity: 


co 


-  (r1-w)M1  sin(0^)  4-  r2M2sin(02) 


Ml  +  M2 


Calculate  linear  combination  of  state  errors  to  provide  corrective  feedback: 


XERR  =  Kl^X2_X?.,cl^  +  K2^2“^2.d^  + 


where 

x2  d’  ^2  d  aic  desired  values  for  x2  and  0 .,  and 
K,,  K„  K3  are  feedback  gains. 

Place  foot  at  touch-down:  • 

x  „  -  x  -f  x 

ro  CO  ERR 

Take  kinematics  of  model  into  account: 
w  sin^)  =  -  x 

Substitute  (6.21),  (6.22),  and  (6.23)  into  (6.24)  and  solve  for  foot  placement  with  respect  to  hip: 


(6.21) 


(6.22) 


(6.23) 

(6.24) 


iyVt:  sin(0?)  -  (Mt  +  M?)  x[JtR 
TD  r1M1  +  wM2  • 

Apply  leg  kinematics  again  to  obtain  corresponding  leg  angle: 


(6.25) 


*1  = 


Arcsin 


r,M2  sin(0,)  -  (Mj  +  M,)  xp 


err 


r3Mj  +  wM2 


Ihe  servo  given  in  (6.1)  is  used  to  move  the  leg  to  this  angel. 


(6.26) 


Figures  6-6  and  6-7  show  results  from  simulation  using  the  foot  placement  algorithm.  The  data  of  Fig. 
6-6  show  corrccdon  of  a  large  error  in  body  attitude  that  was  introduced  through  the  initial  conditions.  The 
0.5  radian  initial  emu  in  body  attitude.  0,.  was  eorrccrccl  in  about  6  hops.  lit  this  simulation  horizontal 
position  was  not  controlled,  so  die  transient  error  in  horizontal  velocity  causes  the  system  to  come  to  rest  some 
distance  from  die  origin.  Figure  6-7  shows  die  response  of  the  same  foot  placement  Jgoi  idun  to  a  pair  of  step 
changes  in  desired  horizontal  position.  Control  of  x2  is  accomplished  by  implementing  a  position  controller 
of  the  form: 


2,d 


=  tninf  K(x, 


X2,d^’  X  2d, max  ^ 


(6.27) 


Desired  body  angle,  0,  d,  is  also  manipulated  during  translations.  Balance  using  diis  mediod  was  stable  with  a 
variety  of  initial  conditions  and  body  attitudes. 
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Figure  6-6:  Test  of  fool  placement  controller.  At  t  =  0  initi;ii  error  in  body  attitude 
was  0.5  radians.  At  1=1  gravity  is  turned  on  and  hopping  begins.  State  errors 
approached  zero m  about  7  see.  K^=0.05,  K,=0.3,  Kj=ti.l. 

Limit  cycle  oscillations  in  horizontal  velocity  were  observed  in  the  data,  especially  at  forward  velocities  greater 
than  about  .25  m/sec.  Maximum  rate  is  limited  because  motion  of  die  leg  is  restricted  during  stance  by  die 
fixed  hip  angle.  Another  consequence  of  the  fixed  hip  is  die  hunched  posture  assumed  by  the  body  and  leg 
during  travel. 
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Figure 6-7:  Response  of  model  to  step  in  x,^  using  foot  placement  algorithm. 

Horizontal  position  errors  generated  rate  setpoints  as  described  in  text.  K..  =0.18. 

K2=0,3.  K3=0.4.-  1 

6.0.2  Method  2:  Ley  Sweeping 

The  leg  sweeping  algorithm  is  based  on  a  generalization  of  the  foot  placement  approach  just  described,  k 
arises  when  one  thinks  about  the  constraints  imposed  by  constant  velocity  travel,  die  legged  system’s 
kinematics,  the  forces  generated  between  the  foot  and  die  ground,  and  the  need  to  balance.  We  start  by 
finding  the  nominal  motion  that  will  maintain  constant  forward  velocity  with  no  tipping,  and  then  modify  this 
motion  to  eliminate  deviations  from  the  desired  state.  The  resulting  algorithm  has  two  parts;  one  part  that 
places  the  foot  to  control  balance  and  tipping,  and  another  part  that  moves  the  hip  during  stance  to  control 
forward  velocity. 


Figure  6-8:  When  the  foot  is  placed  in  the  center  of  the  CG-print,  here  is  symmetry 
in  the  model's  motion.  Running  from  led  to  right,  the  lefl-most  drawing  shows 
model’s  configuration  just  before  lOUCti  tJOWN,  the  center  drawing  shows 
configuiation  at  uottom.  and  right-most  drawing  shows  configuration  just  after 
t  IFT-OFF. 

In  natuH  biped  running  each  leg  extends  forward  during  flight  so  that  the  foot  first  touches  the  ground  some 
distance  in  front  of  the  body.  During  stance  the  leg  sweeps  backward  with  respect  to  the  body.  The  foot  then 
leaves  the  ground  some  distance  behind  the  body  and  the  other  foot  extends  forward.  There  is  a  symmetry  in 
this  motion  about  the  point  half  way  through  stance,  when  die  leg  is  directly  under  the  center  of  gravity. 
Figure  6-8  diagrams  the  symmetry.  This  symmetrical  motion  causes  no  tipping  because  die  center  of  gravity 
spends  about  an  equal  time  in  front  of  the  point  of  support,  and  an  equal  time  behind  it.  The  gravitational 
tipping  moments  average  to  zero  throughout  stance. 

In  order  to  achieve  symmetry  of  this  sort  for  the  one-lcg^c  model,  the  control  system  must  determine  the 
locus  of  points  over  which  the  center  of  gravity  v,  ill  travel  during  die  next  stance  period.  We  call  this  locus  a 
CG- print ,  in  analogy  to  a  footprint.  The  length  of  the  CG-print  is  just  die  product  of  the  forward  velocity  and 
the  duration  of  stance.  In  the  steady  state  the  control  system  places  the  foot  in  the  center  of  die  CG-print. 

When  the  attitude  of  die  body  deviates  from  its  desired  value,  die  control  system  moves  die  foot  from  the 
center  of  the  CG-print  to  correct  the  error.  Placing  the  foot  forward  of  die  center  of  die  CG-print  will  create  a 
net  backward  tipping  moment  during  stance,  while  placing  it  behind  drc  center  of  die  CG-print  will  create 
forward  tipping.  Figure  6-9  illustrates  the  three  cases.  A  linear  combination  of  state  errors  to  determine  how 
far  ;o  move  the  foot  from  the  center  of  the  CG-print.  The  mcdiod  uses  the  same  rule  for  placing  die  foot  with 
respect  to  the  center  of  the  CG-print  as  die  last  method  used  for  placing  the  foot  with  respect  to  the  projection 
of  the  center  of  gravity. 


Figure  6-9:  Three  types  of  behavior  when  foot  is  placed  in  CG-print.  a)  Foot  is 
placed  in  center  of  Die  CG-print.  No  angular  change  in  model,  horizontal  velocity  is 
unmodified,  b)  Foot  is  placed  toward  rear  of  CG-print,  causing  body  to  tip  forward 
during  stance  interval,  c)  Foot  is  place  toward  front  of  CG-print,  causing  body  to  tip 
rearward  during  stance  interval.  Horizontal  lines  indicate  CG-print,  locus  of 
projection  of  center  of  gravity  during  stance. 


Motion  of  the  hip  during  stance  generates  forces  between  the  ground  and  the  fooL  that  determine  how  the 
system’s  forward  velocity  will  change.  If  the  system  is  to  progress  at  a  constant  forward  rate  with  no  forward 
acceleration,  then  the  horizontal  component  of  all  forces  acting  on  the  system  must  be  zero.  Viewing  the 
problem  in  a  coordinate  system  that  moves  forward  with  the  hip,  the  task  is  to  make  the  foot  sweep  backward 
at  the  same  rate  as  the  ground.  The  leg  sweeping  algorithm  accomplishes  this  task  by  calculating  a  target 
angle  for  the  hip  at  each  moment  during  stance.  The  target  angle  is  based  on  die  rate  of  forward  travel,  the 
instantaneous  length  of  the  leg,  the  time  that  passed  since  TOUCI  1-down,  and  the  placement  of  die  foot 
relative  to  the  hip  at  touch-down.  Under  nominal  conditions  diis  motion  will  cause  the  resultant  force 
acting  on  die  foot  to  be  vertical. 

When  the  forward  velocity  deviates  from  the  desired  value,  die  sweeping  motion  of  the  leg  no  longer  result  in 
a  match  between  the  speed  of  the  foot  and  the  ground.  The  result  will  be  an  accelerating  or  retarding  force 
dial  corrects  die  velocity  error.  Faster  leg  sweeping  will  accelerate  forward  velocity,  and  slower  sweeping  will 
retard  it. 


If  die  duration  of  stance,  die  horizontal  velocity  of  the  body,  and  die  geometry  of  the  vehicle  are  knownv  then 
an  appropriate  leg  angle  for  TOUCH-DOWN  and  a  sweeping  function  for  the  leg  can  be  calculated.  The 
duration  of  stance  can  be  recorded  from  the  previous  hop.  When  the  horizontai  velocity  is  x7,  the  horizontal 
distance  traversed  during  stance,  the  length  of  die  CG-print,  is: 


^XSTANCIi  x2  ^ST 

Combining  (6.28)  widi  (6.25)  a  new  equation  for  foot  placement  is  obtained: 


(6.28) 
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=  w 


r7M.  sin(t),)  -  (Mj-f  M,)  x[;I. 


Ax 
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r1M1  +  wM2 


(6.29) 


For  vertical  hopping  in  place,  where  x2  =  0,  (6.29)  reduces  to  (6.25)  of  die  last  section.  During  stance  leg  angle 
must  change  in  a  specified  way  in  order  to  satisfy  die  symmetry  argument  for  zero  net  ground  force  and 
moment.  At  time  t  during  suince: 


X(t)  S  xro-  •~^AxmNca 
*ST 


(6.30) 


O.icc  again,  taking  die  kinematics  of  die  model  into  account',  a  leg  sweeping  function  can  be  found: 


0V{  t)  =  -Arcsin( — )  (6.31) 

w 

Though  the  leg  is  vertical  only  momentarily  during  each  stride,  a  sweeping  servo  employing  (6.30)  and 
(6.31)  resolves  leg  springiness  into  die  vertical  direction.  Horizontal  foot  motion  is  rigid. 

Figures  6-10.  6-1J,  6-12,  and  6-13  show  the  results  of  simulating  this  algorithm.  Figure  6-10  shows  a  constant 
velocity  translation  at  0.75  m/sec.  These  data  show  that  horizontal  velocity  was  well  controlled,  with  only 
small  variations  within  each  cycle.  The  leg  swung  forward  during  flight  to  place  the  foot,  and  swept  backward 
during  stance  to  minimize  horizontal  ground  forces.  The  leg  and  die  body  counter-oscillated.  Body  attitude 
was  kept  to  within  0.1  radians  of  vertical,  with  a  distinct  0.3  hz  oscillation  superimposed  on  the  stepping 
oscillation. 

To  accommodate  forward  acceleration  a  compromise  between  actual  and  desired  velocity  was  used  to 
calculate  die  lengtn  of  die  CG-print. 


AXSTANCE  j 

r  (VAxmax)TST 

for 

x24<(x2-Axmax> 

(6.32) 
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(X2  +  Axmax>TSt 

for 

X2,d>(x2+AXMAX> 

1  X2.dTST  0thcrW‘SC. 

.<group>  A;<max  limits  d>c  magnitude  of  sudden  changes  in  desired  velocity.  Eq.  (6.32)  replaces  (6.28).  Hie 
controller  employing  this  algoridim  stretches  die  leg  forward  and  lengthens  die  stride  in  order  to  accelerate 
die  model. 

Figure  6  12  demonstrates  regulation  of  forward  velocity  as  die  system  accelerates  smoothly.  The  same  data 
arc  shown  in  cartoon  form,  in  Fig.  6-13  where  die  pattern  of  motion  can  be  more  easily  visualized.  The  paths 
of  the  body  and  foot  arc  indicated  by  a  string  of  dots  dial  correspond  to  equal  time  intervals.  After  about  10 
seconds  the  rate  of  travel  is  2.2  m/scc.  The  rightmost  strides  in  diis  cartoon  show  diat  clearance  of  the  foot 
above  the  ground  was  reduced  as  stride  and  speed  increased.  The  model’s  tendency  to  stub  its  toe  as 
clearance  is  reduced  is  die  factor  that  limits  maximum  speed. 


■  Figure  6-10:  Running  at  constant  horizontal  rate  is  gcncraicd  by  algorithm  that 

places  the  foot  in  the  center  of  the  CG-print.  and  then  sweeps  the  leg  backward 
during  stance.  Rateof  travel  is  .75  m/scc.  (K^0.2, Kj  =0.1,  Kj=0.1) 

’  Figure1  6-11  demonstrates  the  algorithm’s  ability  to  respond  to  changes  in  velocity  setpoint.  'Hie  model  starts 

hopping  in  place,  then  accelerates  to  1  m/scc.  then  to  2  m/scc.  and  then  slows  to  a  stop.  Velocity  control  is 
reasonably  good  once  the  model  has  accelerated  up  to  speed.  Control  of  body  attitude  is  not  particularly 
good.  At  2  m/sec  the  body  deviates  from  vertical  by  about  .3  m/scc. 

6.5.3  Method  3:  Sorvo  Attitude 

The  leg  sweeping  algorithm  maintained  an  even  forward  velocity,  but  it  did  not  control  the  altitude  of  the 
body  with  any  precision.  In  Fig.  6-12  the  body  deviates  from  its  erect  position  by  about  0.3  radians  when 
d  running  at  full  speed.  Instead  of  using  the  hip  actuator  to  sweep  the  leg  according  to  the  mnning  rate,  method 

3  uses  die  hip  actuator  to  erect  the  body  during  stance.  Placement  of  the  foot  in  die  CG-print  is  as  before 
using  (6.22),  (6.28).  and  (6.29): 


■v.'v 
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I'igurc  6-11:  Leg  sweeping  algorithm  controls  running  as  desired  velocity,  x- . 
(shown  suppled  in  second  plot),  changed  in  steps.  (K^  =0.2,  ^=0.1,  =CTl,  Ax 


t( t)  =  Kp(82-0U)  4-  Ky(^)  (6.33) 

where  8 2  d  is  selected  on  each  hop  to  make  Lite  average  body  angle  zero. 

This  algorithm  controls  forward  velocity  through  placement  of  die  foot,  and  die  accelerations  that  result  from 
tipping.  Since  the  hip  servo  erects  the  body  during  stance,  placement  of  the  foot  with  respect  to  the  center  of 
die  CG-print  exclusively  controls  forward  velocity.  K2  =  K2  =  0.  Figure  b-14  shows  die  behavior  of  this 
algorithm  when  executing  the  same  sequence  of  steps  in  forward  velocity  that  were  used  to  produce  Fig.6-12. 

Method  3  is  simpler  to  implement  dian  die  leg  sweeping  algoridim.  It  is  not  necessary  to  servo  a  hip 
trajectory  during  stance,  as  required  by  (6.30).  A  setpoint  for  desired  body  angle  is  specified  once  during 
stance,  and  another  setpoint  for  leg  angle  is  specified  during  flight.  The  fore  and  aft  swinging  motions  of  the 
leg  that  characterize  running  arc  not  explicitly  programmed,  but  the  result  of  interactions  between  the  servos 
that  alternate  satisfying  these  two  setpoints. 
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Figure  6-12:  Sweep  control  algorithm  was  extended  to  generate  horizontal 
acceleration.  Starting  from  rest  the  model  increases  its  rate  of  travel  up  to  about  2.2 
m/sec.  These  data  arc  rcplotted  in  cartoon  form  in  Fig.  6-13.  (K.  =0.2,  Kj=0.1, 

K3=0.1) 

Method  3  is  also  simple  because  it  allows  control  of  running  to  bo  decomposed  into  three  separate  parts.  One 
part  controls  hopping  height  by  regulating  the  amount  of  thrust  delivered  on  each  hop.  A  second  part 
controls  forward  velocity  by  placing  the  foot  with  respect  to  the  center  of  the  CG-piint.  Hie  third  part 
controls  attitude  of  the  body  by  servoing  the  hip  joint  during  stance.  No  explicit  coupling  between  these  parts 
is  required. 

6.6  V.  Conclusion 

The  long  range  goal  of  this  work  is  to  develop  an  understanding  of  balance  and  dynamics  in  legged 
locomotion  that  will  help  to  explain  behavior  observed  in  biological  legged  systems,  and  to  lay  the 
groundwork  needed  to  construct  useful  legged  vehicles.  The  purpose  of  this  paper  is  to  describe  results 
obtained  from  modeling  and  simulating  a  legged  system  that  hops  on  one  leg.  Such  a  model  encourages  focus 
on  the  problem  of  balance,  without  attending  to  die  coordination  of  many  legs. 


Figure  6*13:  Cartoon  of  running  controlled  by  leg  sweeping  algorithm.  Model 
accelerates  from  standing  start  to  about  2.2  m/sec  in  10  sec.  The  dotted  lines 
represent  the  paths  of  hip  and  foot.  (20  msec/dot,  .6  scc/stick  figure.)  Maximum 
speed  is  limited  by  clearance  between  foot  and  ground.  When  the  stride  becomes  too 
long  the  model  stubs  its- toe. 


The  model  consists  of  a  body,  an  actuated  hinge-type  hip,  and  a  leg.  The  leg  is  massful,  it  is  springy,  and  its 
length  can  be  controlled  by  a  position  actuator.  Wc  separate  control  of  (he  model  into  a  vertical  hopping  part 
and  a  horizontal  balance  part.  Vertical  control  takes  advantage  of  the  springy  leg  to  achieve  resonant  hopping 
motion.  The  control  system  regulated  hopping  height  using  a  measure  of  vertical  energy  to  control  the  thrust 
delivered  on  each  hop. 

Horizontal  control  ensure:;  time  the  body  is  maintained  in  an  upright  posture,  and  dial  the  rate  of  forward 
travei  is  well  controlled.  We  explored  three  algorithms  for  horizontal  control;  method  1,  the  foot  placement 
algorithm,  method  2,  the  leg  sweeping  algorithm,  and  method  3,  die  attitude  control  algorithm. 

•  Method  1:  The  foot  placement  algorithm  places  the  foot  with  respect  to  the  projection  of  the 
center  of  gravity,  and  holds  the  hip  fixed  during  stance.  It  maintained  balance  when  hopping  in 
place,  but  could  move  forward  only  slowly. 

•  Method  2:  The  leg  sweeping  algorithm  uses  the  CG-print  to  calculate  a  where  to  put  the  foot  on 
each  step,  and  a  iiip  trajectory  that  will  control  forward  travel.  It  controlled  forward  velocity  with 
good  precision,  but  control  of  body  angle  was  poor. 

•  Method  J;  The  attitude  control  algorithm  also  uses  the  CG-print  to  place  the  foot,  but  hip  torque 
during  stance  controls  body  attitude.  This  simpler  algorithm  control  forward  velocity  and  attitude 
with  good  precision. 

Control  of  ninning  in  the  onc-leggcd  model  can  be  decomposed  into  height  control,  a  forward  velocity 
control,  and  attitude  control. 
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Figure  6-14:  Method  3  algorithm  shown  responding  to  step  changes  in  desired 
velocity,  x,  (shown  stippled).  The  algorithm  generates  hip  torque  during  stance  to 
control  attitude  of  body,  (K.  =0.15,  K,  =0  0,  K,  =0.0,  Ax  =  5) 
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6.7  Appendix  Vil.  Equations  of  Motion  for  Model 

These  equations  were  derived  from  free  body  diagrams  of  the  leg  and  body  using  d’Alembert's  principle. 


yl  =  y0  "  rl(^1sin(^1)  4  ^cosftfj)) 

(6.34) 

xi  =  x0  +  r^cosCtfp  -  tffsin^)) 

(6.35) 

y2  =  y0  +  w  cos (0p  -  wj^sinf^)  -  w0|cos(0j) 

(6.36) 

-  r2«?2sin(6>2)  4  02cos(02))  -  2w^1$in(^1) 

x,  =  xQ  4  w  sin(^j)  4  w^1cos(/91)  -  w^sin(tf  ^ 

(6.37) 

4  r-,(0  ,cos(02)  -  2,sin(0.,))  4  2w01cos(0]) 

Mlyl  ®  Fy  “  F1cos(dl)  +  FNsin^i>  ~  Mig 

(6.38) 

-  Kx  -  .Frsin<<?1)  -  FNcos(^1) 

(6.39) 

=  -Fxr1cos«?1)  4  Fyr1sin(^1)  -  FN(w-r2)  -  r(t) 

(6.40) 

M2y2  =  F^osf^)  -  FNsin«?1)  -  M2g 

(6.41) 

M2x.  =  F^inrifj)  4  Fncos(02) 

(6.42) 

[2^2  ~  F  ,1^0(0,-^)  ”  FNr2COS(^2-^i)  +  T(t) 

(6.43) 

where 

(xQ,y0)  arc  coordinates  of  the  foot, 

(Xj.yj)  are  coordinates  of  the  leg’s  CG. 
(x2,y2)  are  coordinates  of  the  body's  CG, 


FX,F  arc  the  vertical  and  horizontal  forces  on  the  foot,  and 

Ft,Fn  arc  die  tangent  and  normal  forces  between  die  leg  and  body. 

These  equations  are  expressed  in  terms  of  the  state  variables  6^0^  xQ,  yQ,  w  by  eliminating  xr  y2,  x2,  y2>  F, 
and  Ft: 

cos(^1)(M2Ww  +  +  M2r2W  cos(02)tf,  +  M2Wx‘0  +  M2W  sin^Jw  =  (6.* 

WM2(tf  jw  sin(tf 2)  -  26 cos^^)  +  r2<9jsin(02)  +  r^sin^j)) 

-  ijF^cos2^)  +  cos{^1)(r1Fysin(d1)  -  r(t))  +  FKW  sin(0j) 

-sin(«1)(M2Ww+ Ijrfj  -  M2r2W  sin(02)i?2  +  M2WyQ  +  M2W  cos^w  =  (6.4i 

WM2(^W  cos(^2)  +2^w  sin(^2)  +  r202cos(02)  +  r^cosf^)  -  g) 

+  r]Fxcos(tf1)sin(d1)  -  sin(^1)(r1Fysin(^  t)  -  r(t))  +  FRW  eos^) 

cosf^pCM^W-Ij)^  +  iV^Wxg  =  (6.4C 

W(M1r1tfJsinftf1)  -  F^sin^)  +  Fx)  - 
cos( ^  j^XFy r2si  n(^  2)  -  FJtr1cos(^1)  -  r(t)) 

-sin^XM^W-I^  +  MjWy0  =  (6.47 

W(M1r1(9“cos«?1)  -  FJ.cos(^1)  T  Fy  -  M2g)  - 
sitHfljXF^sirK^)  -  F^cos^)  -  r(t)) 

-cos((?2-^1)I1r2^1  +  I2w^2  =  (6.48 


W(FKr2sin(^2-^1)  +  r( t))  -  r2cos(^2-^1)(r]Fysin(^1)  -  r1Fxcos(^1)  -  r(t)) 


where 


W  as  w-^ 

Fk  "  Ww+X> 

KA-W  +  X)-Buw 

F*  =  ,-Ko(x0-x  J- Vo 

0 


'  for  (kQ-w+x)  >0 
otherwise 

for  yQ  <  0 
otherwise 


(6.49) 

(6.50) 


F. 


-Vo ‘Vo 
0 


for  y0  <  0 
otherwise 


(6.5  L) 


«\  v  ,  1,%.W  *,*.***.*,„  *.;0  ■i**..--/'  -•*  %**.  */  ‘.  ,>  WV„,%  w",,K  |/Yi*  \,’  \-  V  V.V  “ ’♦'•’■‘u ’  r’.,  ■ 
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6.8  Appendix  VIII.  Simulation  Parameters 


Mj  =  1  kg 
IL  =  1  kg-n;2 
rj  =  .5  m 
kQ  =  1  m 
Kl  =  103Nt/m 
Ku  =  105Nt/m 
K,'  =  104Ni/m 

j 

H  -  1.8  in 

Kp  =  1800  Nt-m/rad 
1200  Nt-m/rad 

Ky  =  200  Nt-in-sec/rad 
60  Nt-m-sce/rad 


M2  •■=  10  kg 
I2  =  10  kg-m2 
r2  =  .4  m 


Bj  j  =  125  Nt-scc/m 
Bu  =  75  Nt-sec/m 


for  yQ<0 
otherwise 

for  y0<0 
otherwise 
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